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The  study  of  human  driving  of  automotive  vehicles  is  an  important  aid  to  the 
development  of  viable  autonomous  vehicle  navigation  and  control  techniques. 
Observation  of  human  behavior  during  driving  suggests  that  this  activity  involves 
two  distinct  levels,  the  conscious  and  the  unconscious. 

The  behavior  of  a  driver  while  stopping  his  vehicle  at  a  stop  sign  can  be 
conscious  or  unconscious,  depending  on  the  driver’s  skill  level  and  the  driving 
conditions.  The  driver’s  behavior  involves  a  difficult  process  of  estimating  the 
distance  to  the  stop  sign  and  the  velocity  of  the  vehicle.  Using  these  estimates,  the 
driver  then  takes  the  necessary  control  actions  to  stop  the  vehicle.  This  research 

attempts  to  mimic  the  driver’s  conscious  and  unconscious  behavior  through 
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I.  INTRODUCTION 


A.  GENERAL  BACKGROUND 

Man  has  been  intrigued  by  the  concept  of  robots  for  centuries.  The  earliest 
robots  were  mechanical  toys  moved  by  clockwork  mechanisms.  As  time  passed, 
the  world  became  more  complex  and  man  began  to  develop  concepts  which  would 
later  provide  a  basis  for  research  and  experimentation  in  more  versatile  robotics. 
Jules  Verne,  an  author  of  science  fiction,  was  one  of  those  pioneers.  He  somehow 
anticipated  a  most  successful  method  in  robotics,  the  use  of  pneumatic  or 
hydraulic  actuators  for  individual  joints  in  a  steam  elephant.  [Ref.  l] 

Over  the  years,  the  concept  of  a  robot  has  changed  considerably.  Science 
fiction  writers  and  movie  makers  often  project  the  image  of  a  robot  as  some  type 
of  sublime  creature  or  menacing  evil.  The  popular  American  idea  is  that  of  an 
artificial  man  [Ref  2].  The  concept  of  an  artificial  mem  is  linked  to  the  belief  that 
mechanical  slaves  could  free  a  substantial  portion  of  the  world’s  population  from 
manual  work  [Ref.  3]. 

While  not  humanlike  in  appearance,  in  fact,  mechanical  slaves  called 
industrial  robots  have  been  developed  for  production  work.  These  robots  normally 
operate  from  a  fixed  location  and  are  programmed  to  do  tedious  and  repetitive 
tasks.  Typically,  the  programming  is  accomplished  by  either  leading  the  robot 
through  the  desired  movements  and  recording  these  movements,  or  by  coding  a 
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path  consisting  of  sequences  of  linear  and  circular  motions  [Ref.  4:p.  4].  Recently 
however,  special  robot  programming  languages  have  been  developed  which,  when 
combined  with  modern  force  and  torque  sensors,  allow’  the  robot  to  adjust  to  some 
variations  in  the  environment  [Ref.  4:pp.  395-410]. 

The  next  logical  step  in  robot  development  is  some  type  of  mobile  robot.  The 
"automated  guided  vehicle"  provides  an  intermediate  level  between  fixed  robots 
aind  unconstrained  mobility.  Here,  navigation  problems  are  avoided  by  using  a 
control  network  which  may  be  a  wire,  painted  stripe,  or  track  on  a  factory  floor 
[Ref.  4:p.  8]. 

Research  is  continuing  toward  the  idealized  and  unconstrained  robot.  This 
human-like  or  autonomous  robot  is  capable  of  making  decisions  and  adapting  to 
environmental  changes  which  may  affect  its  purpose.  In  order  to  adapt  to  its. 
environment,  the  autonomous  robot  requires  numerous  human-like  sensors  for 
input.  Thus,  studies  are  being  conducted  in  the  areas  of  vision,  touch,  and 
hearing.  Additionally,  research  is  ongoing  in  related  areas  of  artificial  intelligence. 
The  objective  is  an  autonomous  robot  capable  of  analyzing  sensor  input  and 
making  decisions  to  produce  intelligent  actions  [Ref.  4].  Currently,  studies  of  such 
machines  are  very  diversified  and  must  be  integrated  at  some  time  in  the  future  to 
produce  an  effective  autonomous  robot. 

Perhaps  then,  the  way  to  construct  an  autonomous  robot  capable  of  decision 
making  in  real-world  problems  is  to  integrate  the  features  of  a  human;  the  human 
senses,  the  human  brain,  and  human  behavior.  This  would  result  in  a  very 
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complex  hierarchical  system  with  interactive  and  parallel  processors.  [Ref.  5]  A 
system  of  this  type  is  well  beyond  the  scope  of  this  work.  Therefore,  the  objective 
of  this  work  is  limited  to  the  study  of  a  small  portion  of  human  behavior. 
Specifically,  this  research  investigates  and  attempts  to  mimic  the  mental  process 
by  which  a  human  driver  controls  the  speed  of  a  conventional  automotive  vehicle 
when  coming  to  a  stop  at  a  stop  sign  or  a  traffic  light.  This  is  an  area  of 
autonomous  vehicle  research  which  has  been  largely  ignored,  but  which  may  well 
be  pertinent  to  the  viability  of  future  autonomous  vehicles,  especially  on-road  and 
wheel-based  vehicles. 

B.  ORGANIZATION 

Chapter  II  introduces  vehicle  dynamics  and  discusses  human  control  of  speed 
and  direction  in  vehicles.  Additionally,  this  chapter  reviews  a  number  of  research 
projects  relating  to  longitudinal  speed  control  in  autonomous  vehicles.  Finally, 
Chapter  II  introduces  computer  vision  and  discusses  its  limitations. 

The  objective  of  this  research  work  in  relation  to  autonomous  vehicles  and 
human  drivers  is  discussed  in  greater  depth  in  Chapter  III.  In  that  chapter,  the 
assumptions  concerning  conventional  automotive  vehicle  mechanics  and 
characteristics  of  human  driving  are  detailed.  Those  assumptions  are  described  to 
show  that  the  graphics  simulation  implemented  for  this  study  ignores  many  of  the 
complex  interactions  that  occur  between  a  human  driver,  his  vehicle,  and  the 
environment  while  traveling  on  the  highway.  These  assumptions  are  made  to 


make  the  graphics  simulation  manageable  and  feasible  within  the  time  constraints 
of  the  study.  The  mathematical  model  of  longitudinal  speed  control  by  a  human 
driver  used  in  this  research  is  derived  and  detailed  in  Chapter  III. 

In  Chapter  IV,  the  design  and  implementation  of  the  graphics  simulation  for 
the  mathematical  model  are  presented.  The  graphics  workstations  and  the 
displays  on  each  workstation  are  discussed  in  detail.  Additionally,  this  chapter 
elaborates  on  the  computer  networking  system  and  how  it  is  used  in  this  project. 
The  overall  design  strategy  and  key  issues  of  longitudinal  speed  control  for  the 
mathematical  model  are  addressed  in  depth.  The  functions  and  implementation 
of  the  various  modules  developed  for  the  simulation  are  described.  Finally,  a 
user’s  guide  is  included. 

Numerous  experiments  are  conducted  with  the  graphics  simulation  to  verify 
the  mathematical  model  of  Chapter  III  and  validate  this  work.  Chapter  V  records 
and  explains  the  results  of  the  experiments  conducted  using  the  simulation  model 
developed  in  Chapter  IV. 

The  last  chapter,  Chapter  VI,  summarizes  the  work  and  its  potential  benefit 
to  autonomous  vehicle  research.  Some  suggestions  concerning  possible  extensions 
to  the  research  are  also  provided.  Additional  work  in  these  areas  could  make  the 
present  study  more  comprehensive  and  substantive. 

Chapter  VI  is  followed  by  a  list  of  reference  material  used  in  this  study. 
Lastly,  the  graphics  simulation  source  code  is  attached  as  appendices. 


II.  REVIEW  OF  PREVIOUS  WORK 


A.  INTRODUCTION 

Research  in  autonomous  vehicles  has  been  ongoing  for  many  years.  Initially, 
progress  was  slow  and  difficult,  partially  because  of  the  limitations  of  available 
technology.  The  results  of  early  research  indicate  that  many  areas  of  autonomous 
vehicle  research  are  extremely  complex  and  remain  open  to  study.  However,  in 
recent  years,  many  advances  and  technological  breakthroughs  have  made  feasible 
tasks  which  were  previously  impossible. 

Some  of  the  research  that  has  been  completed  on  autonomous  vehicles  is 
presented  in  this  chapter  to  illustrate  the  nature  and  complexity  of  the  pi-oblems 

encountered.  Additionally,  this  chapter  contains  a  brief  discussion  on  vehicle 
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dynamics.  Lastly,  the  current  status  and  limitations  of  computer  vision  in 
relation  to  autonomous  vehicles  are  discussed. 

B.  VEHICLE  DYNAMICS 

There  are  many  complex  interactions  occurring  between  a  moving  vehicle  and 
its  environment  which  must  be  considered  in  any  study  involving  vehicle 
dynamics.  Some  of  these  interactions  are  discussed  here  to  provide  insight  on 
subjects  which  may  have  an  impact  on  the  research  at  hand. 


1.  Tire  and  Road  Forces 


The  main  forces  arising  between  the  tires  and  the  road  are  those  resulting 
from  acceleration  and  deceleration  in  the  forward  or  reverse  direction  and  from 
turning.  The  forces  caused  by  acceleration  and  braking  of  a  vehicle  are  related  to 
the  load  carried  by  the  wheels  and  the  coefficient  of  friction.  Cornering  a  vehicle 
produces  complex  lateral  forces,  making  computations  difficult,  especially  when 
acceleration  or  braking  is  involved.  Nearly  all  tire  wear  is  the  result  of  these 
forces.  [Ref.  6] 

2.  Rolling  Resistance 

Rolling  resistance  exists  because  tires  are  not  rigid  and  change  shape  as 
they  come  in  contact  with  the  roadway.  When  the  wheel  turns,  the  portion  of  the 
tire  coming  in  contact  with  the  road  bulges  and  flexes.  As  the  rotation  continues 
and  this  portion  of  the  tire  leaves  the  road,  the  tire  returns  to  its  original  shape. 
Because  the  tire  momentarily  changes  shape,  energy  is  consumed.  The  resistance 
to  this  motion  is  called  rolling  resistance.  [Ref.  6] 

3.  Air  Resistance 

The  amount  of  resistance  attributed  to  aerodynamic  drag  depends  on 
many  factors  such  as  vehicle  shape,  frontal  size,  and  velocity.  Large,  thick  vehicle 
bodies  show  a  predominance  of  drag  due  to  pressure  built  up  to  the  vehicle’s  front 
as  it  travels  in  the  forward  direction  at  high  velocities.  This  effect  can  be 
minimized  in  slender  streamlined  vehicle  bodies  with  smooth  contours.  [Ref.  7] 


4.  Slip  Angle  and  Side  Forces. 

Slip  angle  and  side  forces  are  encountered  when  a  rolling  wheel  is  acted 
on  by  a  side  force.  The  side  force  is  normally  caused  by  centrifugal  forces  when 
the  vehicle  negotiates  a  curve.  The  road  usually  acts  on  the  tire  in  a  direction 
opposing  the  side  force.  The  angular  difference  between  the  direction  of  motion 
and  the  true  wheel  rolling  direction  is  called  the  slip  angle.  [Ref.  6] 

5.  Other  Effects. 

The  tires  and  the  vehicle  are  acted  on  by  other  forces  too  numerous  to 
discuss  in  this  work.  Some  of  these  forces  include  self-aligning  torque,  gyroscopic 
effects,  roll  forces,  suspension  effects,  vibrations,  and  engine  torque. 

C.  AUTOMATIC  SYSTEMS  FOR  LATERAL  AND  LONGITUDINAL 

CONTROL 

1.  Highway  Vehicles. 

Since  the  1960’s,  numerous  research  groups  have  investigated  highway 
automation  as  a  possible  solution  to  some  of  the  problems  posed  by  an  ever- 
increasing  number  of  motor  vehicles  [Refs.  8-16).  These  traffic  problems  cannot  be 
solved  by  building  larger  and  faster  highways  since  the  cost  of  construction  is 
prohibitive.  Additionally,  as  vehicle  speeds  increase,  highway  safety  becomes  an 
important  issue.  In  the  late  1960's,  Fenton  and  Olson  suggested  a  solution 
involving  automated  highways  [Ref.  8].  On  the  automated  highway,  traffic  flow  is 
increased  by  decreasing  the  distance  between  vehicles  through  automatic  control. 
The  authors  hoped  that  such  a  system  could  greatly  increase  lane  capacity  at  high 


speeds  while  still  reducing  the  number  of  highway  accidents.  In  this  concept, 
described  in  [Ref.  8],  each  vehicle  has  two  modes:  a  manual  mode  for  use  on  rural 
roads  where  the  vehicle  is  controlled  by  the  driver,  and  an  automatic  mode  for  use 
on  the  automated  highways. 

To  control  vehicle  speed  and  spacing,  some  type  of  longitudinal  controller 
is  required.  This  could  be  a  centralized  computing  system  which  is  capable  of 
maintaining  a  complete  overview  of  the  traffic  at  all  times  or  an  independent 
system  installed  on  each  vehicle.  Additionally,  each  vehicle  requires  sensor 
equipment  to  measure  vehicular  spacing  and  relative  velocity.  The  information 
provided  from  such  measurements  must  be  analyzed  and  appropriate  control 
signals  sent  to  the  vehicle.[Ref.  8] 

In  another  study  of  vehicle  automatic  longitudinal  control,  Bender, 

t 

Fenton,  and  Olson  investigated  a  car  following  system  to  increase  both  highway 
capacity  and  highway  safety.  The  research  vehicles  in  this  work  were 
instrumented  so  that  braking,  acceleration,  and  steering  are  managed  by  an 
automatic  control  system.  Road  tests  were  then  conducted  using  several  vehicles. 
The  tests  were  designed  to  gather  data  on  the  acceleration  and  deceleration  of  the 
following  vehicle  in  response  to  velocity  changes  by  the  lead  vehicle.  [Ref.  9] 

The  results  of  the  various  road  tests  show  that  automatic  system 
performance  can  be  superior  to  that  of  a  human  driver,  especially  in  situations 
where  emergency  braking  is  required.  Of  note  is  that  reaction  time  to  full  braking 

was  0.4  seconds  for  the  automated  system  compared  to  0.5  -  1.0  seconds  for  an 
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alert  driver  in  a  similar  situation.  In  many  cases,  if  the  following  vehicle  had  been 
under  driver  control  when  the  lead  vehicle  applied  emergency  braking,  a  rear  end 
collision  would  probably  have  resulted.  [Ref.  9] 

In  later  work,  Fenton  and  Chu  focused  on  control  of  vehicles  entering  the 
highway  environment  and  on  control  of  vehicles  traveling  on  the  highway.  Here,  a 
vehicle  controller  was  designed  and  tested  under  full  scale  conditions.  The  vehicle 
was  capable  of  responding  to  all  non-emergency  commands  in  a  satisfactory 
manner  while  maintaining  passenger  comfort.  [Ref.  13] 

Additionally,  other  research  studies  have  been  conducted  on  lateral 
steering  control.  Fenton,  Melocik,  and  Olson  used  a  vehicle  which  tracked  a  cable 
buried  beneath  the  surface  of  the  roadway.  Sensors  on  the  vehicle  measured  the 
magnetic  field  produced  by  the  current  in  the  wire.  Then,  tlje  measurements  were 
processed  to  provide  the  vehicle’s  position  with  respect  to  its  driving  lane.  Several 
different  controllers  were  designed  and  tested  under  full  scale  conditions.  Results 
of  the  tests  indicate  that  excellent  lateral  control,  good  insensitivity  to 
disturbances,  and  comfortable  ride  could  be  obtained  using  a  simple  single  loop 
controller.  [Ref.  11] 

The  term  mechatrontes  is  applied  when  electronic  components  have  been 
intimately  integrated  with  mechanical  systems.  In  automobiles,  this  technique 
provides  designers  with  new  opportunities  to  improve  automobile  handling, 
performance,  and  safety.  El-Deen  and  Seireg  use  mechatronics  to  improve  a 
vehicle’s  ability  to  perform,  even  when  traveling  at  high  speeds  on  low  friction 


surfaces  [Ref.  17].  Their  concept  uses  a  miniaturized  computer  system 
incorporated  in  the  vehicle’s  power  steering  unit.  The  computer  reads 
preprogrammed  rules  to  enhance  the  vehicle’s  steering  performance  during 
critical  situations  when  a  driver  may  not  have  sufficient  time  or  experience  to 
react. 

With  a  computer  simulation,  the  authors  were  able  to  show  that  the 
proposed  system  improved  vehicle  stability  in  critical  road  conditions.  The 
vehicle’s  computer-controlled  steering  system  uses  the  preprogrammed  rules  to 
implement  corrective  steering  inputs  in  real  time.  This  concept  could  readily  be 
expanded  to  include  control  of  vehicle  braking  and  acceleration,  thus  providing 
improved  overall  performance.  [Ref  17] 

2.  Automated  Guided  Vehicles. 

The  concept  of  the  automated  guided  vehicle  (AGV)  system  embraces  all 
transportation  systems  that  can  function  without  a  driver.  The  AGV  is  a  flexible 
unit  suitable  for  simple  transport  operations  with  a  small  number  of  destinations 
or  for  complex  and  centrally-controlled  transport  processes  [Ref.  18].  A  study  of 
AGV’s  includes  all  types  of  driverless  industrial  trucks,  such  as  fork  trucks  and 
electric  tractors.  Due  to  industrial  demands.  AGV's  also  include  different  types  of 
conveyor  assemblies  and  trolleys.  However,  the  discussion  to  follow  is  limited  to 
driverless  industrial  trucks. 

Successful  research  with  process  control  by  a  central  computer  system  and 


the  use  of  on-board  microprocessors  have  allowed  AGV  Systems  to  compete  with 


other  truck  systems.  Each  installation  consists  of  several  components  which 
include  the  trucks,  the  network,  the  load  handling  system,  the  truck  controller, 
and  a  traffic  controller.  The  trucks  and  the  load  handling  system  are  of  the 
standard  industrial  type  and  are  not  discussed  in  detail  here.  However,  the  reader 
should  understand  that  each  truck  is  modified  for  steering  control,  speed  control, 
and  load  management  by  the  automatic  systems. 

The  network  usually  consists  of  a  guidance  system  and  signal  devices  for 
information  transfer.  Networks  range  from  a  simple  closed  course  in  small 
factories  to  complex  systems  with  multiple  guidewires  and  switches  providing 
many  possible  routes  in  large  installations.  Information  transfer  is  simple  and 
most  often  passive.  Signal  devices  such  as  permanent  magnets,  infrared 
transmitter*,  or  light  signals  provide  information  to  the  on-board  processor 
concerning  the  current  vehicle  location,  speed  restrictions,  or  other  pertinent 
data,  as  necessary  for  a  specific  implementation. 

Most  on-board  truck  controllers  have  several  functions  which  include: 

-  lateral  steering  control  to  keep  the  truck  on  course, 

-  route  control  which  moves  the  truck  through  a  network  to  its  goal,  and 

-  longitudinal  speed  control  and  braking. 

In  typical  systems,  lateral  steering  is  controlled  by  a  track  or  the 
magnetic  field  surrounding  an  electrically  excited  guidewire  beneath  the  surface  of 
the  road.  In  the  guidewire  implementation,  two  coils  on  the  vehicle  are  used  to 


sample  the  magnetic  field  produced  by  the  current  carrying  wire.  If  the  truck 
deviates  from  the  intended  course,  a  difference  in  the  voltage  produced  by  the  two 
coils  is  noted  and  triggers  a  control  signal  to  initiate  a  steering  correction. 

The  longitudinal  speed  control  portion  of  the  truck  controller  receives 
information  from  several  sources.  These  sources  include  network  signal  devices, 
vehicle  separation  devices,  and  the  route  controller.  Most  trucks  have  only  a  few 
operating  speeds,  making  the  task  of  the  longitudinal  speed  controller  simpler. 

Route  planning  is  the  most  difficult  problem  in  the  control  system  design 
and  can  be  accomplished  on-board  the  truck  by  a  processing  unit,  at  a  central 
processing  computer,  or  with  a  combination  of  on-board  processing  and  a  central 
computer.  Typically,  small  companies  with  a  limited  number  of  trucks  cannot 
afford  the  expense  of  .a  data  link  between  individual  trucks  and  the  central 
computer.  Additionally,  an  on-board  route  processing  system  provides  added 
reliability  over  a  single  centralized  system. 

Regardless  of  the  type  of  route  planning  system  that  is  implemented,  the 
control  process  involves  job  planning,  job  management,  truck  planning,  truck 
management,  and  optimization.  The  task  of  a  centralized  computer  processor  is 
complex  and  can  involve  numerous  priorities  and  prerequisites  as  determined  by 
the  network,  the  task,  and  management. 

With  on-board  route  planning,  the  vehicle  destination  is  typically  input 
by  means  of  data  transmission  as  the  vehicle  passes  a  certain  position  in  the 
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network.  Thus,  a  certain  portion  of  the  planning  function  is  centrally  controlled. 
This  technique  forms  a  hierarchical  structure  and  allows  the  system  to  be 
autonomous  at  all  levels. 

3.  Ohio  State  University  Adaptive  Suspension  Vehicle 

The  Ohio  State  University  Adaptive  Suspension  Vehicle  (ASV)  is  a 
prototype  legged  robot  intended  to  provide  performance  characteristics  desirable 
in  a  military  rough  terrain  vehicle.  The  ASV  is  a  hexapod  that  uses  statically 
stable  gaits  while  moving.  It  can  carry  its  operator  and  an  internal  payload  of  500 
pounds.  The  machine  is  powered  by  a  motorcycle  engine  that  drives  a  flywheel 
and  18  variable  displacement  hydraulic  pumps.  [Ref.  19] 

The  ASV  is  equipped  with  a  network  of  17  microcomputers  to  coordinate 
foot  placement,  leg  movement,  and  the  control  of  body  attitude,  thereby  freeing 
the  operator  for  higher  level  decisions  concerning  speed  and  direction.  The 
operator  can  control  forward  and  lateral  velocity,  rate  of  turn,  body  height,  and 
attitude,  if  necessary.  [Ref.  19] 

To  ensure  careful  foot  placement  in  rough  terrain,  the  ASV  is  equipped 
with  a  sophisticated  terrain  scanning  system  that  is  based  on  continuous  wave 
phase  comparison  using  infrared  light.  The  light  beam  is  scanned  at  a  2  Hz  rate 
in  a  raster  pattern  covering  the  ground  ahead  of  the  ASV  to  a  range  of  about  10 
meters. 

Outdoor  trials  of  the  ASV  hexapod  were  initially  conducted  in  1986. 
During  the  first  tests,  the  walking  machine  demonstrated  that  it  is  capable  of 


movement  in  open  fields  at  speeds  in  excess  of  2  mph.  It  can  also  negotiate  simple 
obstacles  and  ditches.  Tests  are  continuing. 

4.  FMC  Corporation  Autonomous  Land  Vehicle 

The  aim  of  this  project  is  to  develop  an  automatic  pilot  that  can  control 
an  autonomous  land  vehicle  in  real  time.  The  system  is  based  on  the  M1I3A2 
tracked  and  armored  personnel  carrier  that  is  controlled  from  a  command  trailer. 
[Ref.  20] 

This  system  uses  a  hierarchical  control  architecture  with  subsystems 
named  the  Planner,  the  Observer,  the  Mapmaker,  the  Pilot,  and  the  Vehicle 
Controller.  As  indicated  by  its  name,  each  subsystem  has  a  well-defined  and 
important  function  to  perform.  [Ref.  20] 

The  highest  control  system,  the  Planner,  uses  digitized  maps  to  select  a 
general  path  to  the  goal  for  its  mission.  The  Planner  is  able  to  incorporate  a 
variety  of  mission  requirements  into  the  path  selection  process.  Typical  mission 
requirements  can  include  minimizing  detection  of  the  vehicle  by  the  enemy, 
minimizing  the  time  of  the  mission,  or  minimizing  the  energy  consumption  to 
accomplish  the  mission.  The  path  provided  by  the  Planner  is  in  an  abstract  form 
consisting  of  segments  with  left  and  right  boundaries.  These  segments  are  output 
in  LISP  syntax  and  include  a  general  heading  to  the  goal  and  a  maximum  vehicle 
velocity  for  that  segment. 

The  main  function  of  the  Observer  is  situation  assessment  and  resolution. 
This  is  based  on  the  segmented  path  received  from  the  high  level  Planner  and  on 


information  received  from  on-board  sensors  such  as  an  obstacle  detector  and  an 
inertial  land  navigation  system.  The  output  of  the  Observer  is  a  more  usable  plan 
for  the  next  subsystem,  the  Mapmaker. 

The  Mapmaker  generates  the  Pilot  Map  containing  the  global  path 
border,  the  nearest  obstacle  borders,  and  the  sensor  visibility  limits.  Here,  the 
output  of  the  obstacle  detection  sensor  is  combined  with  the  plan  from  the 
Observer  to  create  the  Pilot  Map. 

The  Pilot  Map  is  a  local  map  in  a  format  that  the  Pilot  can  use.  It  is  the 
Pilot’s  responsibility  to  guide  the  vehicle  along  a  feasible  route  staying  within  the 
constraints  provided  by  the  Planner  and  avoiding  unforeseen  obstacles.  The  Pilot 
is  able  to  generate  subgoals  and  select  an  optimum  path  in  real  time  because  of 
the  hierarchical  nature  of  the  system.  Once  an  optimal  path  is  selected,  the  Pilot 
issues  instructions  to  the  lowest  level  subsystem,  the  Vehicle  Controller. 

Field  tests  of  the  FMC  Corporation  Autonomous  Land  Vehicle  indicate  it 
can  perform  obstacle  avoidance  successfully  and  complete  path  execution  at  5 
mph.  The  system  is  now  being  improved  to  deal  with  more  complex  terrain 
features.  [Ref.  20] 

5.  Martin  Marietta  Autonomous  Land  Vehicle 
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making.  The  main  modules  in  this  design  are  the  Reasoning  Subsystem,  the 
Perception  Subsystem,  and  the  Control  Subsystem.  [Ref.  21] 

The  Perception  Subsystem  incorporates  various  sensors  to  provide  real 
time  input  on  the  surrounding  terrain.  A  three-dimensional  model  of  the  local 
terrain  is  generated  by  combining  input  from  the  different  sensors.  This  model  of 
the  terrain  is  used  by  the  Reasoning  Subsystem  for  path  planning. 

The  Reasoning  Subsystem  consists  of  a  goal  seeker,  a  navigator,  and  a 
knowledge  base.  This  subsystem  interprets  the  mission  goals  and  any  limitations 
which  may  apply.  The  goalseeker  analyzes  the  mission  and  uses  the  knowledge 
base  to  provide  the  navigator  with  numerous  subgoals  oriented  toward  the 
mission  goal.  The  navigator  combines  the  subgoals  with  the  three-dimensional 
model  from  the  Perception  Subsystem  to  provide  several  possible  trajectories. 
Finally,  cost  functions  are  applied  to  the  possible  trajectories  to  determine  one 
route  for  the  vehicle  to  follow.  The  Control  Subsystem  converts  the  selected 
route  to  steering  and  speed  commands  to  drive  the  vehicle.  [Ref.  21] 

D.  COMPUTER  VISION 

Computer  vision  is  an  important  subfield  of  artificial  intelligence.  A  strong 
demand  exists  for  computer  vision  applications  in  nearly  every  area  of  robotics. 
Still,  it  is  a  slow,  difficult  process  and  there  is  a  natural  desire  by  researchers  to 
understand  human  vision  as  a  problem  which  could  result  in  the  development  of  a 
general  methodology  for  solving  computer  vision  tasks.  [Ref.  4:pp.  255-277] 
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The  problem  of  computer  vision  is  to  give  a  computer  a  picture  of  a  scene  and 
have  the  computer  determine  what  the  objects  are  in  the  scene  and  what  their 
spatial  relationships  are  [Ref.  22 j.  The  most  powerful  computers  often  require 
more  than  a  minute  to  process  a  single  scene  that  a  human  can  interpret  in  the 
blink  of  an  eye.  As  a  result,  at  present,  it  appears  impossible  to  interpret  image 
sequences  in  real  time  for  a  moving  autonomous  robot  [Ref  4:pp.  301-308]. 

Another  difficulty  with  computer  vision  is  the  combining  of  sensor  input  with 
intelligence  to  perform  vision.  As  long  as  the  robot  or  vehicle  is  moving  along  a 
country  road  with  occasional  houses  and  trees,  the  knowledge  of  what  is  expected 
is  available.  But  if  the  vehicle  is  allowed  to  move  into  a  different  environment 
with  different  terrain  and  varied  scenery,  with  current  knowledge  representation 
and  knowledge  learning  techniques,  it  is  impossible  to  give  the  computer  adequate 
information  or  time  to  analyze  its  new  surroundings.  [Ref.  22] 

Considerable  progress  has  been  made  in  the  field  of  computer  vision  in  the 
last  decade,  especially  in  the  areas  of  industrial  machine  vision  systems  that  use 
simple  image  processing  and  pattern  recognition.  However,  more  work  is  needed  in 
the  area  of  autonomous  vehicles  in  order  to  provide  consistent  real  time  data. 

E.  SUMMARY  AND  CONCLUSIONS 

A  brief  overview  of  vehicle  dynamics  is  provided  in  this  chapter. 
Additionally,  some  of  the  research  in  a  variety  of  different  autonomous  vehicles 
has  been  reviewed  to  gain  an  understanding  of  the  complexity  involved.  It  is 
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noted  that  sophisticated  systems  such  as  autonomous  land  vehicles  require 
specialized  high  performance  parallel  processing  systems  to  operate  in  the 
environment  demanded  of  them.  The  ability  of  an  autonomous  vehicle  to 
complete  its  mission  also  depends  on  the  speed,  accuracy,  and  quality  of  its 
computer  vision  system.  Without  these  requirements,  autonomy  is  very  difficult,  if 
not  impossible  to  achieve. 

In  the  next  chapter,  the  problem  statement  for  this  work  is  refined.  The 
assumptions  for  the  selected  vehicle  model  are  detailed  and  the  vision  model  is 
described.  As  the  chapter  proceeds,  the  control  model  used  for  the  simulation  in 
this  work  is  developed  and  linearized. 
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III.  DETAILED  PROBLEM  STATEMENT 


A.  INTRODUCTION 

In  this  chapter,  the  model  used  for  the  three-dimensional  graphics  simulation 
is  described  in  detail.  To  assist  the  reader  unfamiliar  with  control  theory,  a  brief 
description  of  the  purpose  of  developing  a  mathematical  model  is  given. 
Additionally,  a  linearization  of  the  mathematical  model  is  included. 

The  aim  of  this  research  is  to  examine  and  study  longitudinal  speed  control 
and  braking.  This  serves  as  motivation  for  developing  a  three-dimensional 
graphics  simulation  model.  This  technique  attempts  to  mimic  the  way  a  human 
controls  the  speed  of  his  vehicle  on  the  road,  with  particular  attention  to  the 
aspect  of  braking. 

The  hypothesis  is  that  human  drivers  make  errors  estimating  the  distance  to  a 
desired  stopping  point.  We  also  make  errors  estimating  vehicle  speed  and 
estimating  vehicle  response  when  the  brake  is  applied.  Humans  develop  an 
acceleration  and  deceleration  plan,  which  we  unconsciously  maintain  while  we  are 
driving.  Through  experience  and  training,  humans  have  an  approximate  model  of 
vehicle  maximum  braking,  vehicle  stopping  distance,  and  vehicle  acceleration  and 
deceleration  capability.  The  acceleration  and  deceleration  plan,  which  this  work  is 
primarily  concerned  with,  is  some  fraction,  a  ,  of  the  vehicle’s  maximum  stopping 
capability,  where  0  <  a  ^  1. 
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The  amount  by  which  a  varies  from  the  maximum  vehicle  stopping  capability 
depends  on  several  factors  such  as  the  vehicle  speed,  the  available  stopping 
distance,  the  road  surface  conditions,  the  skill  and  experience  of  the  driver,  and 
the  general  nature  of  the  environment.  Here,  the  environment  includes  variables 
such  as  traffic  conditions,  weather  conditions,  dangerous  situations,  and  the 
degree  of  the  emergency  causing  the  acceleration  and  deceleration  plan  to  be 
executed.  In  normal  stopping  conditions  a  <r  1,  and  for  emergencies  a  =  1. 

B.  VEHICLE  MODEL 

The  mathematical  model  used  to  describe  the  vehicle  must  be  simple  enough 
to  provide  insight  into  the  behavior  of  the  system,  yet  detailed  enough  to  provide 
an  adequate  description  of  the  system.  To  keep  our  vehicle  model  simple,  the 
acceleration  and  deceleration  plan  is  executed  only  on  straight  road  sections  and 
the  effects  of  steering  on  the  vehicle  are  ignored. 

Many  interactions  between  the  driver,  the  vehicle  and  the  environment  are 
also  ignored  to  keep  the  complexity  of  the  mathematical  braking  model 
manageable.  It  has  been  assumed  that  braking  is  perfect  in  the  sense  that  the 
maximum  vehicle  stopping  capability  can  be  reached  without  skidding,  swaying, 
sliding,  or  any  other  unusual  braking  effects.  Additionally,  tire  dynamics  as  well 
as  shock  and  strut  effects  are  ignored.  The  above  restrictions  and  assumptions 
eliminate  any  rotational  moments  and  allow  the  vehicle  to  be  idealized  as  a 
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point  mass.  The  model  can  be  further  simplified  by  allowing  velocity  and 
acceleration  vectors  only  along  the  vehicle  centerline,  eliminating  sideslip  angles. 

C.  ROAD  MODEL 

This  work  assumes  that  near  perfect  conditions  are  available  for  the 
autonomous  vehicle.  The  only  obstacles  on  the  road  and  in  the  vehicle  path  are 
stop  signs  and  traffic  signals  with  green,  yellow,  and  red  lights.  The  signal  devices 
are  called  semaphores.  These  seemingly  unreasonable  assumptions  were  made  to 
allow  the  author  to  concentrate  on  the  deceleration  plan  rather  than  on  obstacle 
avoidance  or  image  and  vision  processing,  where  there  are  already  numerous 
research  activities  [Refs.  23-29].  Additionally,  the  road  and  surrounding  terrain  is 
flat,  eliminating  the  influence  hills  have  on  the  vehicle  as  well  as  restricting  the 
mathematics  to  two  dimensions. 

D.  VISION  MODEL 

The  vision  model  for  this  study  is  based  on  that  developed  by  McGhee.  Zvda. 
and  Tan.  Their  model  consists  of  a  set  of  road  points  representing  the  center  of  a 
closed-course  track.  In  the  automatic  driving  mode  of  that  system,  the  vehicle 
continuously  selects  road  points  to  its  front  and  uses  those  selected  road  points  as 
targets  to  steer  towards.  [Ref.  30:  p .30] 

This  model  extends  that  notion  and  associates  with  each  road  point  a 
maximum  safe  speed,  r  .  This  maximum  safe  speed  is  the  smaller  of  two 
possibilities: 
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-  the  speed  limit  for  that  stretch  of  road  or 

-  the  maximum  safe  speed  to  come  to  a  stop  at  some  known  point,  say  the 
location  of  a  stop  sign  or  semaphore. 

This  notion  is  depicted  graphically  in  Fig  3.1. 

As  the  driver  approaches  a  stop  sign,  his  perception  of  the  distance  to  the 
stop  sign,  dp,  and  of  the  vehicle’s  velocity,  vp,  is  typically  in  error.  In  this  study, 
it  is  assumed  that  the  distance  the  driver  perceives  to  the  stop  sign  is  proportional 
to  the  actual  distance  to  the  stop  sign.  That  is, 

ir  -  M.'  (3.1) 

where  dfl  is  the  actual  distance  to  the  stop  sign  and  k d  is  a  distance  multiplier. 
For  this  study,  it  is  somewhat  arbitrarily  assumed  that  0.8  <  kd  <  1.2  for  most 
drivers.  Thus,  as  the  vehicle  intersects  the  driver’s  acceleration  and  deceleration 
plan,  the  driver  makes  an  initial  error  estimating  the  distance  to  the  stop  sign.  It 
is  further  hypothesized  here  that  the  driver  maintains  this  error  with  small 
deviations  as  he  continues  to  the  stop  sign.  To  reflect  this,  kd  is  modeled  as 

=  *  +  M* )’  (3-2) 

where  is  the  estimate  the  driver  makes  at  the  start  of  the  deceleration  plan 
and  is  the  random  error  he  makes  while  continuing  his  deceleration  plan. 

By  substituting  Eq.  (3.2)  into  Eq.  (3.1),  dp,  the  driver's  perceived  distance  to  the 
stop  sign  becomes 


d,  *  (*,  +  kt(t))da. 


The  driver  also  makes  errors  in  his  velocity  estimate,  v  .  These  errors  can 
be  modeled  in  a  similar  manner  so  that 


v,  m  (3-4) 

where  t; ■  is  the  vehicle’s  actual  velocity  and  kf  is  a  speed  multiplier  with 
typical  values  assumed  to  be  in  the  range  0.8  <  kt  <  1.2.  The  driver  also  makes 
an  initial  error  estimating  his  velocity  and  maintains  this  error  with  small 
deviations  as  he  continues  to  approach  the  stop  sign.  The  speed  multiplier  k 
can  thus  be  modeled  as 

kt  —  kj  +  kn(t),  (3.5) 

where  kf  is  the  estimate  the  driver  makes  at  the  start  of  his  deceleration  plan 
and  kn  is  the  random  error  he  makes  while  decelerating.  Substituting  Eq.  (3.5) 
into  Eq.  (3.4)  yields 

%  =  (*/  ^  M0)«V  (3-6) 

The  magnitude  of  the  errors  the  driver  makes  in  his  estimates  d  or  t> 

p  p 

depends  on  many  influencing  factors  such  as  attentiveness,  driver  skill,  road  and 
weather  conditions,  etc.  However,  a  study  of  all  of  these  factors  is  beyond  the 
scope  of  this  work.  Rather,  in  what  follows,  all  of  the  multiplying  factors 
appearing  in  Eq.  (3.1)  through  Eq.  (3.6)  are  simply  treated  as  independent 
Gaussian  random  processes  denoted  ,V(/i.  a)  where  n  is  the  mean  of  the  process 
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and  <7  is  its  standard  deviation.  That  is,  at  the  beginning  of  any  given  trial  of 
simulated  human  braking,  a  random  number  generator  is  used  to  generate 
and  kj.  Symbolically,  from  the  assumption  on  the  range  of  kd  and  kf, 

*  =  JV(1.  o,)  (3.7) 

and 

-  .V(l,  B/).  (3.8) 

In  this  formulation,  all  of  the  factors  involving  average  driver  errors  in  the 
perception  of  speed  and  distance  are  combined  to  determine  a t  and  o ^  with 
small  values  representing  accurate  average  perception  and  large  errors  inaccurate 
perception.  Since  both  kt  and  kj  have  been  postulated  to  typically  lie  in  the 
interval  [0.8,  1.2],  a  value  for  a  around  a  =  0.1  is  appropriate.  That  is,  If  this 
value  is  used,  average  perceived  position  and  velocity  are  within  20  percent  of 
the  true  value  in  95  percent  of  the  simulation  trials. 

Since  kt  and  kn  represent  fluctuations  in  kd  and  kf,  it  follows  that 

kf  =  JV( 0,  ot)  (3.9) 

and 

*.  >  (3.10) 

It  is  assumed  in  this  study  that  these  fluctuations  are  small  in  comparison  to  the 
average  error.  Thus,  a  typical  value  for  o(  and  a  might  be  in  the  range 


0.01  <  a  0.02. 


In  the  absence  of  any  theory  to  guide  the  selection  of  standard  deviations  for 
the  random  processes  discussed  above,  several  representative  values  are  chosen  for 
comparison  to  real  human  driving  of  the  vehicle  simulation.  A  more  exhaustive 
investigation  of  this  issue  is  left  to  future  research. 


E.  CONTROL  MODEL 

To  develop  the  extended  vision  model,  assumptions  and  restrictions  stated 
earlier  in  this  chapter  are  used.  These  constraints  limit  the  vehicle  to  flat  straight 
roads  and  allow  the  author  to  treat  the  vehicle  as  a  point  mass.  Therefore,  for 
vehicles  traveling  down  the  highway,  the  shortest  distance  d  to  a  stop  sign  at 
which  braking  can  commence  is 


max 


2 

r 


where  r  is  the  time  to  go  to  the  stop  sign  defined  as 


(3.11) 


T  = 


t 


•top  iign 


-  t 


(3.12) 


and  amax  is  the  maximum  braking  acceleration.  In  this  equation,  t  represents 
the  clock  time  at  the  current  vehicle  position  while  tft  is  the  clock  time  at 

which  the  vehicle  arrives  at  the  stop  sign.  Thus, 
dr 

—  =  -  1.  (3.13) 

dt 
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From  Eq.  (3.11),  the  maximum  safe  speed  defined  in  the  vision  model  is 


x  =  a  r. 

max  max 


(3.14) 


The  minimum  value  for  r  can  be  determined  from  Eq.  (3.11)  and  substituted 
into  Eq.  (3.14),  providing  a  maximum  safe  speed  x  at  any  distance  d  from  the 
stopping  point.  The  result  is  a  maximum  braking  curve  determined  by 


(3.15) 


A  graph  of  the  maximum  braking  curve  is  shown  in  Fig  3.2. 


For  a  driver  desiring  to  stop  his  vehicle  at  a  stop  sign,  the  brake  must  be 
applied  prior  to  reaching  the  last  possible  braking  point.  This  can  be 
accomplished  by  employing  the  previously  discussed  acceleration  and  deceleration 
plan  in  which,  during  braking,  the  vehicle  acceleration  is 


abrake  =  ““max’  0  <  O  ^  1. 


(3.16) 


If  a  =  1,  the  driver  has  used  maximum  braking  and  the  vehicle  velocity  is  shown 
by  Fig  3.2.  For  routine  braking  situations.  0  <  a  <  1  and  a  typical  graph  is  as 
shown  in  Fig  3.3. 


F.  LINEARIZED  ANALYSIS 

For  a  vehicle,  the  braking  deceleration  is  a  function  of  brake  pedal  depression 
b  such  that 


°b rake  * brakt * brake  >  °' 


(3.17) 
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Additionally,  the  engine  provides  some  braking.  A  representation  of  engine 
braking  was  developed  by  McGhee,  Zyda,  and  Tan  [Ref.  30:  p.33j  as 


=  —  (xe  -  i  ) 


(3.18) 


where  xc  is  the  commanded  velocity  resulting  from  accelerator  depression  and 
rfl  is  the  acceleration  time  constant.  Now  the  total  acceleration  due  to  braking  is 


x  =  —  a,  ,  -r  a  ■ 

brake  engine 


(3.19) 


After  substitution  of  Eq.  (3.18),  this  becomes 


x  =  -  aL 


—  {xc-  i  ). 


(3.20) 


Substituting  Eq.  (3.17)  into  Eq.  (3.16)  yields  a  brake  pedal  depression  value  of 


Ta  ^ brake 


(3.21) 


where  it  is  assumed  that  the  driver  removes  his  foot  from  the  accelerator  before 
applying  the  brake.  This  value  is  to  be  applied  at  the  moment  the  vehicle 
intersects  the  deceleration  plan,  shown  as  point  A  in  Fig  3.3.  However,  drivers 
are  human  and  often  make  errors  judging  the  distance  to  the  stop  sign  and 
estimating  the  vehicle  velocity.  To  remedy  these  problems,  two  integral  terms  are 
added  to  Eq.  (3.21),  resulting  in  the  brake  pedal  depression  equation 
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b  = 


a 


brake 


k  (d  ,  —  d  )  -  k  (v 

a '  p Ian  o'  v  i  i 


*  /V  U  i 

max  p '  plan 


p/an 


^a  k  brake 


(3.22) 


where  dplan  is  distance  from  the  stop  sign  in  the  driver’s  acceleration  and 
deceleration  plan,  v  lan  is  the  closing  velocity,  dp  is  the  distance  to  the  stop  sign 
as  perceived  by  the  driver,  v  is  the  velocity  of  the  vehicle  as  perceived  by  the 
driver,  kp  is  the  position  gain  factor,  and  kv  is  the  velocity  gain  factor. 

By  substituting  Eq.  (3.22)  into  Eq.  (3.17)  and  using  the  result  in  Eq.  (3.20), 
the  vehicle  net  acceleration  is  given  by 


*  ~  kbrakekp(dplan  ^p)  +  k brake kv(V plan  Vp) 


1 


aa 


max 


+ 


X. 


(3.23) 


Since  the  vision  model  assumes  that  the  average  driver  error  in  estimating 
distance  and  velocity  is  zero,  for  purposes  of  linearization,  from  Eq.  (3.1)  it  can  be 
assumed  that 


<>,  -  *.■  '  (3.24) 

For  the  same  reasons  from  Eq.  (3.4), 

vp  =  va  =  *•  (3-25) 


To  continue  the  linearization,  it  must  be  noted  that  if  x  is  taken  as  the  distance 


from  the  vehicle  starting  point  to  its  current  location,  and  x 


is  the  location  of 


the  stop  sign,  then 


and  thus 


stop 


X 


d  .  —  d  -  d  .  —  (x  .  —  x ). 

plan  p  plan  '  stop  ' 

Using  Eq.  (3.25)  and  this  result,  Eq.  (3.23)  becomes 

X  =  ~  ^brake^p^plan  ~  Xstop  +  2)  +  ^  brake  plan  ~  X) 


—  aa 


max 


or 


x  +  k 


'brake 


A,  X  T 


brakt  p 


(3.26) 


(3.27) 


(3.28) 


kbrakekp(Xstop  ^ plan )  +  k  brake  *vV plan  ““mW  (3.29) 

Using  standard  control  theory  techniques,  the  characteristic  equation  associated 
with  Eq.  (3.29)  is 

A2  +  *jA  +  kQ  =  0  (3.30) 

where 

brake  (3.3l) 
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and 


k  —  4"  k  k 

K0  ^  KpK  brake' 


(3.32) 


From  Eq.  (3.26),  the  associated  eigenvalues  are 


\  *1 

k\ ' 

+1 

1 
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2 

(3.33) 


For  critical  damping,  eigenvalues  Aj  and  A2  must  be  equal,  real,  and  negative. 
[Ref.  31]  This  occurs  if  the  second  term  of  Eq.  (3.33)  is  zero,  giving 


*o  = 


(3.34) 


and 


A  =  -• 


(3.35) 


G.  SUMMARY 

The  basis  for  any  computer  simulation  is  a  detailed  mathematical  model. 
The  purpose  of  this  chapter  has  been  to  develop  a  model  which  cam  be  used  in  a 
computer  simulation  to  study  longitudinal  speed  control.  In  the  next  chapter,  the 


programming  environment  and  the  computer  simulation  model  are  discussed  in 
detail.  A  user’s  guide  is  also  provided. 
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IV.  SIMULATION  MODEL 


A.  INTRODUCTION 

Several  methods  for  implementing  the  mathematical  model  developed  in  the 
previous  chapter  were  examined  during  the  formulation  of  this  study.  The  design 
selected  by  the  authors  is  an  extension  of  the  three-dimensional  color  graphics 
animation  model  implemented  by  McGhee.  Zyda,  and  Tan  in  work  closely 
paralleling  this  research  [Ref.  30:pp.  46-67]. 

To  support  this  work,  the  simulation  implemented  by  McGhee,  Zyda,  and 
Tan  was  modified  to  provide  vehicle  control  through  manual  methods  or  with  an 
autosteer/cruise  control  system.  This  was  facilitated  by  networking  two  IRIS 
(Integrated  Raster  Imaging  System)  workstations,  one  with  the  vehicle  simulation 
and  one  with  a  vehicle  controller.  The  two  IRIS  workstations  communicate  over 


the  Local  Area  Ethernet  Network  in  use  at  the  Naval  Postgraduate  School.  The 
selected  design  provides  several  different  control  modes  for  vehicle  operation  and 


enables  a  user  to  control  the  simulation  from  either  IRIS  workstation  with  manual 
methods,  autosteer/ cruise  control,  or  a  combination  of  manual,  autosteer,  and 
cruise  control. 


The  remainder  of  this  chapter  discusses  the  programming  environment,  the 
three-dimensional  graphics  simulation,  and  the  networking  techniques  used.  First, 
the  programming  environment  is  discussed.  Next,  the  display  on  each 


workstation  is  described  in  detail.  Also,  the  Local  Area  Network  and  its  use  in 
this  research  are  examined.  Additionally,  the  autosteer/cruise  control  system  and 
vehicle  operating  modes  are  reviewed.  A  complete  description  of  all  modules  and 
supporting  files  used  for  the  simulation  is  provided.  Lastly,  a  user's  guide  is 
included. 

B.  PROGRAMMING  ENVIRONMENT 

1.  Hardware 

The  IRIS  2400  Graphics  Workstation,  manufactured  by  Silicon  Graphics, 
Inc.,  is  the  target  hardware  for  the  design,  development,  and  implementation  of 
the  mathematical  model  developed  in  Chapter  III  of  this  work.  The  workstation  is 
a  high  resolution  system  capable  of  combining  real-time  color  graphics  while 
operating  under  the  UNIX  operating  system  [Ref.  32-33]. 

2.  Programming  Language 

The  UNIX  operating  system  on  the  IRIS  workstation  supports  C, 
FORTRAN,  Pascal,  and  Franz  LISP.  The  C  programming  language  was  chosen 
for  this  work  since  a  large  portion  of  the  software  was  produced  in  C  during 
earlier  work  by  McGhee,  Zyda,  and  Tan  [Ref.  30].  Additionally,  communications 
packages  developed  at  the  Naval  Postgraduate  School  are  implemented  in  C  and 
require  low  level  system  calls  which  are  most  easily  handled  by  programs  also 
written  in  the  C  language  [Ref.  34]. 
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C.  DISPLAYS  AND  DRIVING  COURSE 


1.  Vehicle  Simulation  on  Driver's  Display 


The  vehicle  display  includes  a  dashboard  with  operating  instructions  and 
instrumentation  on  the  lower  portion  of  the  IRIS  monitor  and  an  "out-of-the- 
windshield"  view  of  the  highway  environment  on  the  upper  portion  of  the  IRIS 
monitor,  as  shown  in  Fig.  4.1.  This  display  has  been  named  the  "driver’s  display" 
and  corresponds  very  closely  to  an  environment  with  an  onboard  operator, 
whereas  the  display  on  the  second  IRIS  workstation,  shown  in  Fig.  4.2,  has  been 
named  the  "navigator’s  display,"  corresponding  to  a  remote  control  environment. 
Of  course,  the  driver’s  display  could  also  be  interpreted  as  part  of  the  remote 
environment  if  the  vehicle  is  assumed  to  be  equipped  with  an  on-board  television 
camera  and  a  video  data  link. 

The  highway  environment  consists  of  a  closed-course  track  constructed 
with  four  straight  sections  of  simulated  asphalt  and  four  curved  sections  of 
simulated  asphalt.  Intersections,  stop  signs,  speed  limit  signs,  and  a  semaphore 
have  been  added  to  the  software  developed  by  McGhee,  Zyda,  and  Tan  [Ref. 
30:pp  46-67],  Fig.  4.2  is  an  overhead  view  of  the  closed-course  track  showing  the 
locations  of  the  semaphore  and  the  stop  signs. 

2.  Control  Simulation  on  Navigator’s  Display 


The  navigator’s  display  is  executed  on  an  IRIS  workstation  which  is 
networked  to  the  driver’s  display.  This  IRIS  system  projects  an  overhead  view  of 
the  closed-course  track  on  the  left  portion  of  the  monitor  and  essential  vehicle 
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Out-of-the-Windshield"  View  on  the  Driver’s  Display 
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Circuit  on  the  Navigator’s  Display. 


instrumentation  on  the  right  portion  of  the  monitor  as  depicted  in  Fig.  4.2. 
Additionally,  the  progress  of  the  vehicle  on  the  highway  is  provided  by  crosshairs 
which  axe  updated  as  the  vehicle  moves  around  the  highway  circuit. 

D.  NETWORKING 

The  two  IRIS  workstations  used  in  this  research  communicate  on  a  Local 
Area  Ethernet  Network.  The  Ethernet  can  transfer  serial  packets  of  data  at  a 
maximum  transfer  rate  of  10  megabits  per  second  [Ref.  35:  pp.  80-86]. 

In  addition  to  Ethernet,  this  work  utilizes  a  prototype  multimedia  computer 
conferencing  system  designed  by  Manley  to  effect  continuous  communications 
between  two  programs  executing  on  separate  computers  [Ref.  34].  During 
program  execution,  pertinent  vehicle  information  such  as  vehicle  coordinates, 
distance  from  the  start  of  the  highway  circuit,  vehicle  velocity  and  vehicle  braking 
information  is  continually  transmitted  from  the  driver’s  display  to  the  navigator’s 
display.  Additionally,  the  status  of  the  semaphore  and  the  current  operating 
mode  are  transmitted  to  the  navigator’s  display.  In  return,  the  driver’s  display 
receives  command  and  control  information  from  the  navigator’s  display  which 
includes  commanded  velocity,  vehicle  braking  control,  vehicle  steering  control, 
and  operating  mode. 
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E.  DRIVING  MODES 

The  3D  color  graphics  simulation  developed  for  the  mathematical  model 
presented  in  this  work  can  be  controlled  by  the  user  with  the  IRIS  workstation's 
mouse,  or  by  the  autosteer/cruise  control  feature,  or  by  a  combination  of  mouse 
and  autosteer/cruise  control. 

I.  Lateral  Steering  Control 

Two  methods  of  lateral  steering  control  were  developed  by  McGhee, 
Zyda,  and  Tan  [Ref.  30:pp.  30-45].  Both  methods  are  used  in  this  simulation.  The 
first  method  allows  a  user  at  the  driver’s  display  to  manually  steer  the  vehicle  by 
observing  the  "out-of-the-windshield"  view  on  the  driver's  display  and  using 
lateral  movement  of  the  mouse  on  the  IRIS  workstation.  This  closely  models  the 
"sight  picture"  and  actions  a  driver  would  experience  behind  the  steering  wheel  of 
an  actual  automobile,  a  situation  with  an  onboard  operator.  Since  the  mouse  on 
the  navigator’s  display  can  also  control  the  lateral  movement  of  the  vehicle  model, 
a  remote  control  situation  can  also  be  simulated  with  the  user  at  the  navigator's 
display.  Therefore,  by  selection  of  the  proper  driving  mode,  the  user  can 
manually  control  lateral  steering  from  either  IRIS  workstation. 

The  second  means  by  which  steering  can  be  controlled  is  the  autosteer 
method,  where  the  vehicle  steers  toward  target  points  in  the  center  of  its  driving 
lane.  As  the  vehicle  proceeds,  new  targets  are  continually  selected  such  that  the 
vehicle  constantly  has  a  goal  to  its  front. 
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2.  Manual  Longitudinal  Speed  Control 

Two  methods  of  longitudinal  speed  control  have  been  developed  in  this 
simulation.  In  the  first,  the  user  can  manually  control  the  vehicle  velocity  and 
braking  by  utilizing  the  mouse  on  either  IRIS  workstation  and  by  obser/ing  the 
"out-of-the-windshield"  view  on  the  driver's  workstation,  thus  providing  a 
capability  to  simulate  onboard  or  remote  control  of  vehicle  speed.  Acceleration 
and  deceleration  are  accomplished  by  clicking  the  associated  IRIS  workstation 
mouse  buttons.  This  simulates  the  depression  and  release  of  the  accelerator  in  an 
actual  vehicle.  Braking  is  manually  controlled  by  vertical  displacement  of  the 
mouse  to  apply  brake  pressure  and  by  return  of  the  mouse  toward  its  original 
position  to  reduce  or  remove  the  brake  application. 

Manual  longitudinal  speed  control  can  be  monitored  using  the 
instruments  provided  on  the  dashboard  of  the  driver’s  display  or  with  the 
instruments  provided  on  the  navigator’s  display. 

3.  Cruise  Control 

The  second  method  of  longitudinal  speed  control  employs  an  idealized 
cruise  control  system.  This  system  uses  output  from  a  simulated  vision  system  to 
respond  to  speed  limit  signs,  stop  signs,  and  a  semaphore.  In  routine 
circumstances,  cruise  control  operates  as  in  a  conventional  vehicle  and  maintains 
a  commanded  velocity  for  the  driver.  However,  the  cruise  control  system  in  this 
work  can  also  set  a  new  commanded  velocity  based  on  speed  limit  signs  observed 
by  the  simulated  vision  system  as  the  vehicle  travels  the  closed-course  track. 
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Additionally,  the  cruise  control  system  can  react  to  a  stop  sign  or  semaphore  and 
guide  the  vehicle  to  a  smooth  stop.  After  an  appropriate  delay  at  a  stop  sign,  or 
when  the  semaphore  turns  green,  the  cruise  control  system  accelerates  the  vehicle 
through  the  intersection  while  the  simulated  vision  system  watches  for  new  signs. 

To  maintain  longitudinal  speed  control,  the  cruise  control  module 
analyses  the  vehicle  location,  the  vehicle  velocity,  and  semaphore/stop  sign 
information  using  the  mathematical  model  developed  in  Chapter  III.  Based  on 
the  results  of  this  analysis,  control  information  in  the  form  of  commanded  velocity 
(accelerator  position)  and  brake  position  is  transmitted  from  cruise  control  on  the 
navigator’s  display  to  the  vehicle  on  the  driver’s  display. 

The  cruise  control  method  of  longitudinal  speed  control  can  be  monitored 
with  the  instruments  provided  on  the  dashboard  of  the  driver’s  display  or  with 
the  instruments  on  the  navigator’s  display. 

4.  Modes  of  Operation 

The  simulation  developed  in  this  research  is  designed  to  be  controlled 
from  either  the  driver's  display  (an  onboard  control  situation)  or  from  the 
navigator’s  display  (a  remote  control  situation).  Additionally,  the  user  can  select 
any  combination  of  the  lateral  and  longitudinal  control  methods  previously 
described.  Thus,  the  user  has  nine  different  driving  modes  as  detailed  in  Fig.  4.3. 
The  user  can  change  driving  modes  at  any  time  with  a  single  keystroke  at  the 


keyboard  of  either  display. 


Keyboard  Input  Mode  Description 
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Lgure  4.3  Operating  Modes  and  Terminal  Input 


F.  MODULE  DESCRIPTION  ON  THE  NAVIGATOR’S  DISPLAY 

1.  Navigate.c 

This  module  is  the  control  module  for  the  navigator's  graphics  simulation. 
It  initializes  the  IRIS  workstation,  sets  all  the  local  and  global  variables,  and 
opens  a  connection  to  the  driver’s  display  on  the  second  workstation.  Navigate.c 
receives  and  displays  the  commanded  velocity,  the  vehicle  velocity,  the  vehicle’s 
brake  position,  the  vehicle’s  distance  from  the  start  of  the  course  and  the  vehicle’s 
coordinate  location.  Additionally,  this  module  provides  command  and  control 
information  to  the  driver’s  display.  Lastly,  while  in  manual  steering  modes, 
navigate.c  handles  input  received  from  the  mouse  on  the  navigator’s  display.  Fig. 
4.4  through  Fig.  4.8  is  a  flowchart  of  this  module. 

2.  Cruise.c 

This  module  is  a  key  module  in  the  navigator’s  display  and  is  instantiated 
only  in  the  cruise  control  modes.  Here,  the  module  calculates  the  driver's 
acceleration  and  deceleration  plan  using  Eq.  (3.15).  Next,  simple  vision  input  is 
processed  with  the  current  vehicle  velocity  and  vehicle  location  to  regulate 
longitudinal  speed  control  as  shown  in  Fig.  4.9,  a  flowchart  of  cruise.c.  If  the 
vision  input  indicates  a  stop  sign  within  the  driver’s  acceleration  and  deceleration 
plan,  a  call  is  made  to  brake. c  to  stop  the  vehicle.  Brake. c  is  used  in  a  similar 


manner  during  semaphore  color  processing. 


START 


END 


(See  Figure  4.5 
for  more  detail) 


Figure  4.4  NAVIGATOR. C  Flowchart 
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3.  Brake.c 


Brake.c  has  several  functions,  but  is  also  instantiated  only  during  the 
cruise  control  modes.  First,  this  module  calculates  dp,  the  driver’s  perceived 
distance  to  the  stop  sign  using  Eq.  (3.3)  and  the  vision  theory  developed  in 
Chapter  III  of  this  work.  Also,  brake.c  computes  vp ,  the  driver’s  perceived 
velocity  using  Eq.  (3.6).  Finally,  the  module  provides  abrake,  the  braking 
deceleration  for  the  vehicle  utilizing  Eq.  (3.28).  Engine  braking,  as  defined  in  Eq. 
(3.18),  is  computed  in  the  vehicle  simulation.  Fig.  4.10  is  a  flowchart  of  this 
module. 

4.  Signal.c 

This  module  is  also  instantiated  in  the  cruise  control  modes.  Signal.c 
provides  vehicle  control  input  for  the  different  light  phases  of  the  semaphore  in 
the  highway  environment  as  depicted  in  Fig  4.11. 

5.  Clear.c 

Clear .c  has  only  a  single  function.  It  is  called  in  the  cruise  control  modes 
after  a  complete  stop  at  a  stop  sign.  The  module  simulates  a  driver  observing 
that  it  is  safe  to  proceed  through  an  intersection.  Clear.c  uses  the  system  clock  to 
delay  an  arbitrary  length  of  time,  then  removes  the  brake  and  sets  the 
commanded  velocity  to  the  last  assigned  speed  limit  on  that  stretch  of  highway. 

6.  Mapview.c 

This  module  has  two  main  functions.  First,  mapview.c  builds  an  overhead 
view  of  the  highway  environment  with  its  crossroads,  stop  signs  and  semaphores 
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as  shown  in  Fig.  4.2.  Lastly,  this  module  uses  information  received  by  navigate. c 
from  the  driver’s  display  to  plot  the  vehicle  location  by  moving  crosshairs  around 
the  road  circuit. 

7.  Gauges  .c 

The  function  of  gauges. c  is  to  build  the  instrumentation  and  control 
placard  shown  on  the  right  of  Fig.  4.2.  Data  for  the  instruments  is  provided  by 
navigate.c. 

8.  Mouse.c 

The  function  of  this  module  is  to  allow  the  user  to  manually  govern  the 
vehicle’s  speed  and  braking. 

9.  NetV.c 

NetV.c  was  designed  and  implemented  by  Manley  [Ref.  34].  Its  purpose 
is  to  open  an  Ethernet  connection  to  the  driver’s  display  on  the  other  IRIS 
workstation. 

10.  Checkkey.c 

This  function  monitors  the  keyboard,  allowing  the  user  to  change  driving 
modes  with  a  single  keystroke. 

11.  Savedata.c 

Savedata.c  stores  test  data  which  has  been  saved  during  program 
execution  in  temporary  arrays.  At  program  completion,  savedata.c  is  invoked  and 


writes  the  test  data  to  a  file  named  test. 


12.  Generate. c 


This  module  uses  the  system  random  number  generator  and  provides 
output  in  the  form  of  Gaussian  random  numbers.  The  IRIS’s  random  number 
generator  is  seeded  from  the  system  clock  to  ensure  unique  output  of  uniformly 
distributed  random  numbers  during  each  execution  of  the  simulation.  Then,  a 
Gaussian  distribution  can  be  closely  approximated  by  summing  twelve  random 
numbers  uniformly  distributed  between  -  1  and  +  1  and  dividing  the  total  by 
two. 

13.  Loadintarray.c 

The  function  of  loadintarray.c  is  to  read  vision  information  from  a  file 
named  roadmap  to  an  array  during  program  initialization.  The  vision  information 
is  later  used  by  cruise.c  during  analysis  in  the  cruise  control  modes. 

14.  Welcome. c 

The  purpose  of  this  module  is  to  display  a  welcome  banner  on  the  IRIS 
monitor  while  the  graphics  system  is  initialized  and  files  are  loaded. 

15.  Const. h 

User  defined  constants  for  the  navigator’s  display  have  been  organized  in 
this  file  to  make  future  software  modification  easier.  Const. h  must  be  an  include 
file  in  each  program  module  which  contains  program  constants. 

16.  Vars.h 

All  global  variables  for  navigator's  display  are  in  this  file.  Vars.h  must  be 
listed  as  an  include  file  only  in  the  navigator. c  module. 


17.  Vars.ext.h 

External  variables  which  are  required  when  working  in  the  C 
programming  language  are  in  this  file.  Vars.ext.h  must  be  listed  as  an  include  file 
in  all  modules  other  than  navigator .c 

18.  Vision.h 

This  file  contains  simulated  vision  input  required  for  program  operation. 
The  locations  of  stop  signs,  speed  limit  signs,  and  the  semaphore  are  provided. 
Additionally,  for  each  speed  limit  sign,  there  is  an  associated  3peed  in  the  file. 

19.  Makefile 

This  is  a  utility  for  program  organization  and  management  provided  with 
the  UNIX  operating  system.  It  assists  the  user  by  keeping  track  of  which  files  need 
to  be  recompiled  following  modification.  [Ref.  36:p.  105] 

G.  MODULE  DESCRIPTION  FOR  THE  DRIVER’S  DISPLAY 

Most  of  the  modules  on  the  driver’s  display  were  designed  and  implemented 
by  McGhee,  Zyda,  and  Tan  [Ref.  30:pp.  46-67],  However,  many  modifications 
were  made  to  support  this  work.  Therefore,  all  modules  on  the  driver’s  display 
are  discussed  below  in  depth. 

1.  Carsimu.c 

This  is  the  control  module  for  the  driver’s  display  graphics  simulation. 
Additionally,  carsimu.c  has  several  important  functions.  First,  it  initializes  the 
IRIS  graphics  system,  sets  all  local  and  global  variables,  and  completes  the 
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connection  to  the  navigator’s  display  on  the  other  workstation.  Carsimu.c  also 
transmits  pertinent  vehicle  data  to  the  navigator’s  display  and  receives  command 
and  control  information  in  return.  While  in  the  autosteer  modes,  this  module 
calculates  the  headings  to  the  successive  target  points  in  the  center  of  the  vehicle’s 
driving  lane.  Carsimu.c  also  processes  all  manual  steering  input  from  either  IRIS 
workstation’s  mouse.  Lastly,  it  processes  manual  longitudinal  speed  control  input 
from  the  driver’s  display.  Fig.  4.12  through  Fig.  4.18  is  a  flowchart  of  this 
module. 

Several  changes  have  been  made  in  this  module  to  support  this  research. 
First,  the  target  steering  system  implemented  in  earlier  research  is  dependent  on 
high,  constant  velocities  and  becomes  unstable  at  low  speeds  or  during  complete 
stops.  Therefore,  the  AutoSteer  modes  cannot  be  used  at  velocities  near  zero. 
Thus,  this  module  has  been  changed  to  default  to  a  Manual  mode  whenever  the 
velocity  decreases  to  approximately  3  kph.  This  logic  is  displayed  in  the  flowchart 
of  Fig.  4.14.  Additionally,  checkkey.c,  a  routine  which  scans  for  keyboard  input,  is 
designed  to  accept  AutoSteer  modes  only  when  the  vehicle  velocity  exceeds  11 
kph. 

Lastly,  for  this  work,  the  authors  desired  the  vehicle  be  capable  of 
multiple  laps  on  the  closed-course  track.  This  requires  an  improvement  to 
overcome  the  problem  of  discontinuity  in  the  arctangent  function  used  for  the 
AutoSteer  modes  [Ref  30:p.  66],  An  implementation  of  the  algorithm  is  shown  in 
Fig.  4.19.  In  this  solution,  a %  is  saved  and  used  as  a  reference  in  the  calculation 
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Figure  4.15  Main  Loop  of  Carsimu.c  (Part  3) 


Figure  4.16  Main  loop  of  Carsimu.c  (Part  4) 


of  <7)t1.  If  <7j+1  is  significantly  different  from  cr(,  a  discontinuity  exists  and 
<7  +1  is  adjusted.  In  this  work  a  variation  of  3.5  radians  is  allowed  for  routine 
corrections  and  normal  engagement  of  the  AutoSteer  modes.  When  a 
discontinuity  is  encountered,  a  variation  of  approximately  2?r  radians  is 
observed. 

2.  Circuit.c 

The  primary  function  of  circuit.c  is  to  build  the  highway  environment  for 
the  vehicle  simulation.  Several  modifications  to  support  this  work  were 
incorporated  since  its  design.  First,  a  fourth  curve  has  been  added  to  close  the 
rectangular  circuit  as  shown  in  Fig.  4.2.  Additionally,  two  crossroads  have  been 
added  along  with  three  stop  signs,  several  speed  limit  signs,  and  a  semaphore. 


sigma  =  atan2((gx  -  cx),(gy  -  temp)): 
if  (sigma  -  last  sigma  <  -  3.5) 

{ 

lap  =  1  +  (int)((lastsigma  -  sigma  -  PI)/(2  *  PI)); 
sigma  =  sigma  -r  2  *  PI  *  lap; 
lastsigma  =  sigma; 

} 

else  lastsigma  =  sigma; 
sigma  dot  =  (sigma  -  old_sigma)/deltat; 
old  sigma  =  sigma; 


Figure  4.19  Key  C-code  for  the  Arctangent  Discontinuity. 


3.  Other.c 


This  module  contains  the  support  routines  used  to  build  the  sky, 
mountains,  semaphore,  stop  signs,  and  other  terrain  features  in  the  driver's 
display. 

4.  Find  subgoal.c 

When  in  an  autosteer  mode,  findsubgoal.c  searches  for  the  next  target 
point  to  steer  towards.  The  module  is  designed  such  that  the  target  point  is 
continually  being  computed.  However,  the  information  is  only  used  when  in  an 
autosteer  mode.  This  is  done  for  two  reasons;  first,  to  ensure  the  target  point  is 
always  in  front  of  the  vehicle  and  second,  for  efficiency  when  an  autosteer  mode  is 
engaged. 

5.  Integrates 

This  module  performs  the  Euler-Heun  numerical  integration  required  to 
provide  vehicle  dynamics  [Ref.  30:pp.  64-65].  In  the  autosteer  modes,  the  steering 
angle  for  the  dashboard  display  is  computed.  In  the  manual  modes,  the  module 
allows  the  driver  to  control  the  steering  wheel  angle. 

6.  Displays 

The  dashboard  display  is  built  by  this  module  as  shown  in  Fig.  4.1. 

7.  Checkkey.c 

This  module  responds  to  all  input  from  the  keyboard,  through  which  the 


user  can  change  driving  modes. 


8.  Welcome. c 


Welcome.c  displays  a  welcome  banner  while  the  IRIS  graphics  system  is 
initialized  and  files  are  loaded. 

9.  Letter.c 

This  utility  was  designed  and  implemented  by  J.  Artero  and  R.  Kirsch, 
and  was  later  modified  by  L.  Williamson.  The  module  creates  most  of  the  upper 
case  Roman  alphabet  for  use  in  graphics  displays.  Several  numbers  have  been 
added  to  create  speed  limit  signs  for  our  work. 

10.  NetV.c 

The  function  of  this  module,  designed  by  Manley  [Ref.  34].  is  to  establish 
an  Ethernet  connection  to  the  navigator’s  display  on  the  other  workstation. 

11.  Loadarray.c 

Loadarray.c  reads  a  file  named  roadmap  containing  the  target  points 
which  the  vehicle  steers  toward  while  in  the  autosteer  modes.  For  efficiency,  the 
points  are  stored  in  an  array  during  program  execution. 

12.  Roadmap 

This  is  the  file  containing  the  target  points  which  the  vehicle  steers 
toward  while  in  the  autosteer  modes.  The  points  are  one  meter  apart  and  match 
the  center  of  the  vehicle's  driving  lane. 


76 


13.  Const. h 


Programmer  defined  constants  for  the  driver's  display  are  organized  in 
this  file  to  make  software  modification  easier.  Const. h  must  be  an  include  file  in 
each  program  module  containing  programmer  defined  constants. 

14.  Vars.h 

All  global  variables  for  carsimu.c  are  in  this  file.  Vars.h  is  an  include  file 
only  in  carsimu.c. 

15.  Vars.ext.h 

Vars.ext.h  contains  all  the  external  variables  required  when  programming 
in  the  C  language.  All  modules,  other  than  carsimu.c,  must  list  vars.ext.h  as  an 
include  file. 

16.  Map.c 

This  routine  is  independent  of  the  other  modules  on  the  driver’s  display. 
Map.c  is  used  to  generate  the  roadmap  file  and  the  target  points  the  roadmap  file 
contains. 

17.  Makefile 

This  is  a  utility  for  program  organization  and  management  provided  with 
the  UNIX  operating  system  used  on  the  IRIS  workstations.  Its  purpose  is  to  assist 
the  user  by  keeping  track  of  which  files  need  to  be  recompiled  following 
modification.  [Ref.  36:p.  105] 
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H.  USER’S  GUIDE 

To  execute  the  graphics  simulation,  enter  the  following  commands.  First,  on 
the  driver’s  display  workstation  enter  the  command: 

carsimu 

The  display  will  respond  with: 

Server  waiting  to  connect  to  npscs-irisl 

This  response  indicates  the  driver’s  display  has  opened  a  socket  to  the  second 
workstation.  At  this  time,  on  the  navigator's  display  enter  the  command: 

nav 

The  navigator’s  display  will  complete  the  connection  to  the  other  workstation  and 
graphics  initialization  will  begin.  It  takes  a  short  time  for  the  workstations  to  read 
the  roadmap  into  memory  and  make  ail  the  graphics  objects. 

The  driver’s  display  begins  as  shown  in  Fig.  4.1.  The  top  portion  of  the  IRIS 
monitor  is  the  "out-of-the-windshield"  view  of  the  highway  environment  and  the 
kwer  portion  of  the  display  is  the  vehicle  instrumentation  and  a  control  placard. 

The  navigator's  display,  shown  in  Fig.  4.2,  has  an  overhead  view  of  the 
highway  environment,  on  the  left  portion  of  the  IRIS  monitor.  On  the  right  side  of 
the  monitor  pertinent  vehicle  instruments  and  a  control  placard  are  displayed. 
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A  user  can  change  operating  modes  by  referring  to  the  control  placard  and 
providing  the  appropriate  input  on  the  keyboard  of  either  workstation.  Fig.  4.3 
provides  more  detailed  information  on  the  operating  modes.  To  exit,  enter  an  e 
on  either  keyboard. 

To  control  the  speed  of  the  vehicle  manually,  select  the  proper  mode  (see  Fig 
4.3).  Then,  clicking  the  rightmost  mouse  button  corresponds  to  incrementally 
depressing  the  accelerator  in  a  vehicle  while  holding  the  right  mouse  button 
corresponds  to  steadily  increasing  the  accelerator  depression  in  a  vehicle.  Clicking 
the  center  mouse  button  corresponds  to  incrementally  releasing  the  accelerator 
and  holding  the  center  mouse  button  corresponds  to  steadily  decreasing  the 
accelerator.  A  user  can  release  the  accelerator  immediately  by  clicking  or  holding 
the  left  mouse  button.  The  brakes  can  be  applied  by  displacing  the  mouse 
vertically  (away  from  the  user).  To  remove  or  reduce  the  braking,  move  the 
mouse  toward  its  original  position  (toward  the  user).  Instrumentation  provided  on 
each  display  and  the  "out-of-the-windshield"  view  assist  the  user. 

To  steer  the  vehicle  while  in  one  of  the  manual  steering  modes,  move  the 
mouse  to  the  left  or  the  right,  as  necessary.  The  steering  wheel  turning  rate  and 
displacement  on  the  driver's  display  is  proportional  to  the  speed  and  displacement 
of  the  mouse.  Again,  the  instrumentation  on  each  display  and  the  "out-of-the- 
windshield"  view  assist  the  user.  Additionally,  if  the  vehicle  is  too  close  to  the 
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edge  of  the  highway,  the  Danger  warning  indicator  on  the  driver's  display  will 
begin  to  flash.  If  the  vehicle  should  leave  the  highway  and  crash,  the  user  must 
exit  the  simulation  by  entering  e  on  the  keyboard. 

Test  data  can  be  recorded  by  entering  a  t  on  the  navigator’s  display.  Because 
of  the  v  ilume  of  information  stored,  it  is  recommended  the  this  feature  be 
activated  only  when  conducting  a  trial  simulation.  The  recorder  can  be  toggled  off 
by  entering  t  a  second  time.  At  program  termination,  the  data  is  permanently 
saved  in  a  file  named  test. 

I.  SUMMARY 

The  hardware  and  software  for  the  three-dimensional  graphics  simulation 
model  are  discussed  in  this  chapter.  A  complete  system  has  been  developed 
through  which  experiments  can  be  conducted  involving  both  manual  and 
computer  controlled  longitudinal  speed  control.  In  the  next  chapter,  experiments 


using  this  system  are  described  and  analyzed. 


V.  EXPERIMENTAL  RESULTS 


A.  INTRODUCTION 

Numerous  simulation  trials  were  conducted  with  different  program  variables 
to  check  the  validity  of  the  stated  hypotheses  and  the  correctness  of  the 
mathematical  model  derived  in  Chapter  III.  The  results  of  the  simulation  trials 
were  recorded  and  plotted  for  analysis  and  documentation. 

The  closed-course  track  as  shown  in  Fig.  4.2  has  three  stop  signs  and  a 
semaphore.  However,  for  these  studies,  only  the  semaphore  and  stop  sign  #2  were 
used.  This  allowed  the  driver  or  the  cruise  control  system  adequate  time  to 
stabilize  at  the  maximum  safe  speed  for  that  stretch  of  road  prior  to  encountering 
a  stop  sign  or  a  semaphore  with  a  red  light.  Additionally,  this  work  studies  only- 
speed  control  and  not  the  more  complex  analysis  required  when  approaching  an 
intersection  as  the  semaphore  turns  yellow.  Thus,  for  these  trials,  the  simulation 
was  set  such  tnat  the  semaphore  is  always  red  as  the  vehicle  approaches. 

In  all  experiments,  the  trial  begins  by  setting  and  stabilizing  the  velocity  at 
the  desired  value.  As  the  vehicle  approaches  the  red  semaphore  or  stop  sign  ~  2. 
the  driver  or  cruise  control  adjusts  the  vehicle  speed  and  uses  braking  as  necessary 
so  as  to  stop  at  the  appropriate  location.  The  trial  is  complete  when  the  vehicle 


Several  trials  have  been  made  to  record  the  characteristics  and  results  of 


manual  and  cruise  control  braking.  In  each  case,  regression  analysis  employing  a 
least-squares  fit  has  been  applied  to  relate  the  deviations  resulting  from  several 
stops  [Ref.  37],  Using  the  resultant  curve,  x,  the  total  acceleration  due  to  braking 
can  be  determined.  A  value  for  amax,  the  maximum  acceleration  due  to  braking 
can  be  determined  by  using  the  results  obtained  from  a  trial  with  100%  braking. 
This  is  shown  in  Fig.  5.1.  Now,  the  driver’s  acceleration  and  deceleration  plan 
can  be  calculated  with 


x 

a  =  - 

a 

max 


(5.1) 


The  remainder  of  this  chapter  documents  the  results  of  several  experiments. 
First,  the  trials  conducted  with  manual  longitudinal  speed  control  are  reviewed 
and  the  results  obtained  from  these  experiments  are  discussed.  Then,  the 
experiments  with  the  cruise  control  system,  which  incorporates  the  mathematical 
model  developed  in  Chapter  III.  are  discussed  and  analyzed. 


B.  MANUAL  LONGITUDINAL  CONTROL 

During  the  manual  longitudinal  control  trials,  it  was  found  to  be  extremely 
difficult  to  stop  at  the  required  location.  This  was  attributed  to  a  lack  of  visual 
references  which  help  humans  to  perceive  motion  and  accurately  judge  distances. 
Additionally,  a  time  period  was  required  for  the  driver  to  become  accustomed  to 


the  dynamic  characteristics  of  the  vehicle.  To  help  overcome  these  handicaps. 


velocity  A  braking 


Figure  5.1  Maximum  Braking  provides  acceleration  of  -  1.39  m/s*+2. 


distance  remaining  markers  were  added  at  ten  meter  increments  for  the  last  60 
meters  approaching  the  semaphore.  Also,  the  test  driver  practiced  several  stops  in 
order  to  grow  accustomed  to  the  vehicle  dynamics. 

Typical  results  for  manual  longitudinal  control  are  shown  in  Figs.  5.2  -  5.5. 
In  the  trials  for  Fig.  5.2  and  Fig  5.3,  Driver  #1  and  Driver  #2  attempt  to  stop  at 
the  semaphore  while  the  operating  mode  is  NavSteerDrSp.  This  mode  is  chosen 
because  the  driver  is  responsible  only  for  speed  control  and  not  steering  control, 
resulting  in  a  reduced  workload.  In  both  cases,  the  trials  were  initiated  from  50 
kph.  Fig.  5.2  and  Fig.  5.3  show  the  difficulty  encountered  by  the  drivers  when 
attempting  to  stop  at  a  designated  location.  On  occasion,  one  driver  overshoots 
the  semaphore  and  enters  the  intersection.  Analysis  of  Driver  #  l’s  data  shows  his 
a  is  0.59  and  for  Driver  #2,  a  is  0.76. 

The  trials  for  Fig.  5.4  and  Fig.  5.5  were  initiated  at  75  kph  but  the  operating 
mode  was  ASteerDrSp.  This  mode  also  relieves  the  driver  of  steering  control 
which  is  difficult  at  75  kph  (Ref.  30:p.  70].  Data  for  Fig  5.4  and  Fig  5.5  were 
recorded  while  approaching  stop  sign  #2.  To  stop  in  this  situation,  the  driver 
must  intercept  his  acceleration  and  deceleration  plan  while  the  vehicle  is  traveling 
around  a  curve.  Also,  this  stretch  of  highway  does  not  have  distance  remaining 
markers,  making  it  more  difficult  for  the  driver  to  judge  the  distance  to  the  stop 
sign.  Fig.  5.4  and  Fig  5.5  show  that  on  occasion  both  drivers  fail  to  stop  until  in 
the  intersection.  For  Driver  #1,  a  is  0.73.  An  analysis  of  the  data  in  Fig  5.5 
shows  that  Driver  #2  has  an  a  of  0.82. 


Figure  5.2  Four  Trials  by  Driver  §1 ,  Alpha  is  0.59. 


velocity  A  braking 


Figure  5.3  Four  Trials  by  Driver  #2,  Alpha  is  0.76. 
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C.  AUTOMATIC  DRIVING 

The  most  difficult  portion  of  the  cruise  control  trials  was  finding  a  position 
gain  factor,  kp.  and  a  velocity  gain  factor,  kv.  Note  that  for  this  work,  two 
equations.  Eq.  (3.33)  and  Eq.  (3.34),  have  three  unknown  variables.  From  the 
closely  related  work  of  McGhee,  Zyda,  and  Tan  [Ref  29:p.  39],  A  is  expected  to 
be  small,  and  most  probably  in  the  interval  -  2.0  ^  A  ^  -  0.5.  Therefore,  values 
for  k  and  k  were  calculated  for  -  3.0  ^  A  ^  0.0  in  increments  of  0.1.  The 

p  V 

acceleration  and  deceleration  plan  gain  factor,  a,  was  set  to  0.5.  To  calibrate  the 
system  without  the  effects  of  noise  resulting  from  a  human  driver’s  judgement, 
kd,  the  distance  multiplier,  and  ks ,  the  speed  multiplier  were  both  set  to  1.0. 
Trials  were  then  conducted  for  various  A  within  the  prescribed  domain.  Results 
of  trials  at  high  velocities  show  for  A  >  -  2.0,  the  vehicle  stops  short  of  the 
desired  location.  Subsequent  trials  with  a  =  0.6  and  A  =  -  2.2  showed  the 
vehicle  was  capable  of  stopping  properly  from  various  speeds.  Fig.  5.6  depicts  the 
vehicle  stopping  from  50  kph  and  Fig.  5.7  displays  the  vehicle  stopping  from  75 
kph. 

With  the  system  calibrated,  the  human  driver  is  modeled  by  constructing  kd 
and  k  using  input  from  the  Gaussian  random  number  generator.  Fig.  5.8  is  the 
result  of  four  trials  starting  at  50  kph.  It  is  of  note  that  in  all  cases  the  cruise 
control  super  driver  stopped  the  vehicle  prior  to  entering  the  intersection.  For  the 
super  driver  in  Fig.  5.8,  a  is  0.55.  Similarly,  Fig.  5.9  depicts  four  trials  from  75 


kph.  Again,  the  super  driver  was  successful  in  stopping  the  vehicle  prior  to 


100% 


er  Driver"  at  50  ktnph . 


entering  the  intersection.  In  this  case,  a  is  0.53.  Note  that  the  autopilot  applies 
hard  braking  early  in  the  simulation  trial,  while  the  human  driver  uses  hard 
braking  late  in  the  simulation  trial.  This  may  be  due  to  the  difficulty  the  human 
driver  has  judging  the  distance  to  the  stop  sign. 

D.  SUMMARY 

The  results  of  this  chapter  show  that  the  behavior  of  a  human  driver  as  he 
estimates  the  distance  to  a  stop  sign  and  the  velocity  of  his  vehicle  can  be 
mathematically  modeled.  Additionally,  the  mathematical  model  developed  in  this 
work  mimics  this  conscious  or  unconscious  behavior  to  a  significant  extent. 
However,  before  any  degree  of  confidence  can  be  attached  to  the  hypotheses  of 
this  work,  additional  research  is  needed  to  gather  statistical  data  about  how 
human  acceleration  and  deceleration  plans  vary  with  driving  conditions. 
Therefore,  currently,  the  hypotheses  of  this  work  can  provide  at  most  a  viable 
basis  for  longitudinal  speed  control  in  autonomous  vehicles. 
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VI.  SUMMARY  AND  CONCLUSIONS 

A.  SUMMARY 

This  work  differs  from  previous  research  in  the  area  of  longitudinal  speed 
control  for  autonomous  vehicles  in  that  the  previous  models  did  not  mimic  human 
control  of  the  vehicle.  Rather,  much  current  research  focuses  on  vision,  sensors, 
planning,  navigation,  and  avoidance.  Few,  if  any,  previous  works  explore  the 
behavioral  aspects  of  human  driving  which  could  provide  some  different  insights 
into  possible  approaches  to  autonomous  vehicle  control. 

At  the  start  of  this  work,  it  was  observed  that  human  driving  can  be  divided 
into  two  distinct  levels,  that  of  conscious  and  unconscious  behavior.  This  work  is 
concerned  entirely  with  studying  and  modeling  a  simple  conscious  or  unconscious 
aspect  of  human  driving,  that  of  controlling  the  accelerator  and  the  brake  position 
during  a  stop. 

An  important  product  of  this  work  is  the  development  of  a  three-dimensional 
color  graphics  simulation  model  utilizing  two  graphics  workstations 
communicating  over  an  Ethernet  network.  This  model  provides  a  realistic 
environment  in  which  real-time  experiments  can  be  conducted  to  support  ongoing 
research.  The  model  can  be  modified,  enlarged,  or  enhanced  to  facilitate  related 


work  in  the  future. 


B.  CONCLUSIONS  AND  POSSIBLE  EXTENSIONS 

In  this  simulation,  the  navigator’s  display  is  modularized  for  ease  of 
management,  modification,  and  expansion.  Thus,  several  possible  extensions  to 
this  research  exist.  First,  a  possible  enhancement  to  the  present  system  is  a 
sophisticated  vision  model  requiring  complex  vision  analysis.  The  present  model 
is  simple  and  sees  only  key  signs  and  semaphores.  An  improved  model  could 
possibly  detect  other  traffic,  obstacles,  and  even  pedestrians.  Such  a  model  would 
require  elaborate  techniques  and  algorithms  to  detect  and  analyze  each  situation. 

Additionally,  the  Autosteer  mode  may  be  improved  to  include  automatic 
steering  at  low  speeds  and  possibly  at  a  complete  stop.  This  extension  would  allow 
the  user  to  conduct  simulation  trials  without  being  distracted  by  mode  changes. 

Another  possible  extension  to  this  work  focuses  on  path  planning  and 
navigation.  Such  research  would  entail  a  complex  highway  environment  or  a 
cross-country  environment  with  numerous  routes.  In  this  model,  the  navigator’s 
display  could  select  a  route  based  on  path  planning  and  obstacle  avoidance 
algorithms. 

The  extensions  described  above  require  a  programming  language  and  special 
hardware  suited  for  advanced  artificial  intelligence  applications  such  as  vision, 
path  planning,  and  obstacle  avoidance.  In  consideration  of  these  requirements,  a 
final  extension  to  this  work  involves  replacement  of  the  navigator’s  display  and  its 
host  workstation  by  another  system  on  a  LISP  machine.  The  use  of  the  Ethernet 
communications  in  the  implementation  of  this  work  allows  an  entire  display  and 
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its  host  computer  to  be  readily  replaced  by  a  system  such  as  a  LISP  machine.  An 
implementation  of  the  vehicle  simulation  under  the  control  of  a  navigator’s 
display  on  a  LISP  machine  would  provide  an  improved  platform  for  advanced 
work  in  vision,  path  planning,  and  obstacle  avoidance. 

In  conclusion,  it  is  hoped  that  this  research  will  serve  as  a  basis  and 
motivation  for  advanced  work  in  the  behavioral  aspects  of  human  driving. 
Research  of  this  nature  can  have  a  significant  impact  on  the  development  of 
autonomous  vehicles  of  the  future. 
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APPENDIX  A 


SOURCE  CODE  FOR  THE  NAVIGATOR'S  DISPLAY 


^********************************************** 

filename:  NAVIGATE.C 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 

*************** *******************************y 

f include  "gl.h" 

#include  " device. h" 

^include  " const. h" 

^include  "vars.h" 

#  include  "stdio.h" 

#  include  "math.h" 

^include  "time.h" 

^include.  •  sys/ types. h,> 

#  include  <  sys/times.h> 

^include  "sys/signal.h" 

main() 

{ 


/*  variables  to  control  the  car  */ 


int  lightcolor 
int  command; 
int  condition 
int  status 
int  car; 
int  nbyte; 
int  mode 
int  datatime 
int  systemclock; 
int  starttime; 
int  mousex 


=  RED  LIGHT;  /*  color  of  signal  light  */ 

/*  read/write  variable  */ 

=  0;  /*  signal  received  from  simulation  */  < 

=  0:  /*  read/write  variable  */  I 

/*  socket  number  of  local  system  */ 

/*  read/write  result  */ 

=  0;  /*  control  mode  sent  to  vehcle  */  •  \ 

=  0;  /*  time  counter  for  recording  data  */  jj 

/*  contains  the  system  clock  time  *  /  \ 

/*  initial  value  for  the  system  clock  */  ] 

=  0;  /*  heading  info  from  mouse  */ 


int  thousand,  hundred,  ten,  unit; 

int  statussize,  distancesize,  exsize,  cysize,  commandsize, 
controlsize,  velocitysize,  carstatsize; 

/*  used  to  record  real  time  */ 

/*  heading  and  brake  info  sent  to  car  */ 

/*  cmdvelocity  and  braking  info  from 
cardriver  */ 

/*  used  to  seed  random  number  generator  */ 
/*  the  random  number  generator  */ 

/*  used  to  seed  random  number  generator  */ 
/*  random  number  generator  */ 

char  tempstr[30] ,  thouc[2],  hundc[2],  tenc[2],  unitc[2]; 


int  timedata[1000]; 

long  controlsignal  =  0; 
long  carstat  =  0; 

long  seedval; 

long  float  drand48(); 

void  srandQ; 

float  gaussiangeneratorQ ; 


float  rdistance  =  0.0;  /*  distance  the  vehicle  is  down  the  road  */ 

float  a  max  =  1.8; 

float  temp,  tempval; 

Boolean  notdone  =  TRUE;  /*  used  to  control  display  loop  */ 

Boolean  recorddata  =  FALSE;  /*  used  to  record  data  */ 


extern  long  time(); 
long  clocktime; 
char  *clockc; 


/*  System  clock  */ 

/*  For  clock  value  */ 


struct  tins  mytime; 


/*  Place  to  put  the  time  structure  */ 


/*  function  that  connects  server  to  client  */ 
int  connect_client(); 


statussize  =  sizeof(status) ; 
distancesize  =  sizeof(rdistance); 
exsize  =  sizeof(cx); 
cysize  =  sizeof(cy); 
commandsize  —  sizeof(command); 
controlsize  =  sizeof(controlsignal); 
velocitysize  =  sizeof(velocity); 
carstatsize  =  sizeof  (carstat); 


/*  open  up  the  net  path  to  machine  npscs-irisl  */ 
car  =  connect_client("npscs-iris2”,  5); 


103 


Si****.  jT 


loadintarrayQ;  /*  load  the  vision  data  */ 


ginit();  /*  initialize  the  IRIS  */ 

doublebuffer();  /*  use  doublebuffer  mode  */ 

gconfigQ;  /*  use  the  above  settings  */ 

cursoffQ;  /*  set  the  cursor  off  */ 

qdevice(KEYBD);  /*  check  input  fm  keyboard  */ 

setvaluator(MOUSEX,  250,  0,  500); 
setvaluator(MOUSEY,  -10,  -10,  400); 
noise(MOUSEX.  10); 
noise(MOUSEY.  10); 

color(BLACK);  /*  clear  the  buffers  */ 

clear  (); 

swapbuffers(); 

clear  Q; 

swapbuffers(); 

makethemapview(&mapobj) ; 
maket  hegauges  ( ^gauges ) ; 

welcome();  /*  display  the  welcome  panel  */ 

seedval  =  time((long*)0);-  /*  seed  the  random  number  generator  */ 
srand48(seedval) ; 

/*  generate  random  numbers  */ 
for  (stopcount  =  0;  stopcount  <  10;  -M-stopcount) 

{ 

ksubi  [stopcount]  =  gaussiangeneratorQ; 
ksubf[stopcount]  =  gaussiangeneratorQ: 

} 

stopcount  —  0: 

for  (cyclecount  =  0;  cyclecount  <  150;  ++cyclecount) 

{ 

ksubefcyclecount]  =  ((drand48())  *  0.01)  +  0.01; 
ksubnfcyclecount]  =  ((drand48())  *  0.01)  +  0.01; 

} 
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cyclecount  =  0; 


while(notdone) 

{ 

nbyte  =  write(car,  ^command,  commandsize); 
nbyte  =  write(car,  &controlsignal,  controlsize); 
nbyte  =  read(car,  &status,  statussize); 
nbyte  =  read(car,  ^velocity,  velocitysize); 
notdone  =  status/100; 

lightcolor  =  ((status  -  (notdone  *  100))/ 10); 
condition  =  status  -  (notdone  *  100)  -  (lightcolor  *  10); 
switch  (condition) 

{ 

case  ASteerNSp  : 
case  DrSteerNavSp: 

mousespeedinput(&cmdvelocity,  ^distance,  &eye,  &numsights, 

tklastremembered,  &brakeposition,  &accel  brake); 

break; 

case  NavManual: 

mousespeedinput(&cmdvelocity,  ^distance,  &eye,  &numsights, 

& lastremembered ,  izbrakeposition,  &accel  brake); 
mousex  —  getvaluator(MOUSEX); 
break; 

case  NavSteerDrSp: 

mousex  =  getvaluator  (MOUSEX); 

if  (distance  %  LAPDIST  >  vision[eye][LOCATION]) 

{ 

if  (vision[eyej  [OBJECT]  ==  SPEEDLIMIT) 
lastremembered  =  vision[eye]  [SPEED]; 
if  (eye  <  numsights)  eye  =  eye  4-  1; 

} 

nbyte  =  read(car,  Jzcarstat,  carstatsize); 
accelbrake  =  -carstat/1000; 

cmdvelocity  =  (int)((carstat%1000)  *  MPS_TO_KMPH); 
break; 

case  ASteerDrSp:  if  (distance  %  LAPDIST  >  vision[eye][LOCATION]) 

{ 

if  (vision[eye] [OBJECT]  ==  SPEEDLIMIT) 
lastremembered  =  vision[eye][SPEED]; 
if  (eye  <  numsights)  eye  =  eye  +  1; 

} 

nbyte  =  read  (car,  dzcarstat,  carstatsize) ; 


■  1*  ■  4*  ,  „  «t  »%  .  H.  «>,  A«-  l<.  rt.  it.  lt.'4».'tl..  it. 


accel_brake  =  -carstat/1000; 

cmdvelocity  =  (int)((carstat%1000)  *  MPS  TO_KMPH); 

break; 

case  DrManuakif  (distance  %  LAPDIST  >  visionfeye] [LOCATION]) 

{ 

if  (vision[eye] [OBJECT]  ==  SPEEDLIMIT) 
lastremembered  =  vision[eye]  [SPEED]; 
if  (eye  <  numsights)  eye  =  eye  +  1; 

} 

nbyte  =  read(car,  &carstat,  carstatsize); 
accel_brake  =  -carstat/1000; 

cmdvelocity  =  (int)((carstat%1000)  *  MPS_TO_KMPH); 
break; 

case  CruiseNavSteer:  mousex  =  getvaluator(MOUSEX); 
case  AUTOPILOT: 
case  CruiseDrSteer: 

cruisecontrol(systemclock,  a_max,  lightcolor); 

cmdvelocity  =  cruisevelocity; 

break; 

}  /*  switch(condition)  */ 

/*  reset  vision  array  after  every  lap  */ 
if  ((distance  +  1)  %  (LAPDIST  -  1)  ==  0) 
eye  =  0; 

nbyte  =  read(car,  &cx,  exsize); 
nbyte  =  read(car,  &cy,  cysize); 
nbyte  =  read(car,  &rdistance,  distancesize); 

distance  =  rdistance; 
thousand  =  distance/ 1000; 

hundred  =  (distance  -  (thousand  *  1000))/100; 

ten  =  (distance  -  (thousand  *  1000)  -  (hundred  *100))/10; 

unit  =  distance  -  (thousand  *  1000)  -  (hundred  *  100)  -  (ten  *  10); 


clocktime  =  time((long‘)0); 
clockc  =  ctime(&ciocktime); 
systemclock  =  times  (&my  time); 
sprintf(thouc,  "%d",  thousand); 
sprintfjhundc,  "%d",  hundred); 
sprintf(tenc,  "%d",  ten); 
sprintf(unitc,  "%d",  unit); 


/*  record  the  system  clock  */ 


editobj  (mapobj ) ; 

if  (lightcolor  GREENLIGHT) 

{ 

objreplace(greenlighttag) ; 
color  (GREEN); 
objreplace(redlighttag) ; 
color  (DIMRED); 

} 

if  (lightcolor  ==  YELLOWLIGHT) 

{ 

objreplace(yellowlighttag) ; 
color  (YELLOW); 
objreplace(greenlighttag) ; 
color  (DIMGREEN); 

} 

if  (lightcolor  ==  REDLIGHT) 

{ 

objreplace(redlighttag); 

color(RED); 

objreplace(yellowlighttag) ; 
color(DIM  YELLOW); 

}  . 
objreplace(cartag) ; 
move2(cx-5.0,-cy) ; 
draw2(cx+5.0,-cy); 
move2(cx,  -cy-5.0); 
draw2(cx,  -cy+5.0); 

/*  display  the  system  time  */ 
objreplare(timetag); 
charstr(clockc); 

if  (recorddata) 

{ 

sprintf(tempstr,  ”%s  ki  %.3f  kv  "RECORDING". 

ksubi[stopcount] ,  ksubffstopcount] ) : 
objreplace(testtag) ; 
charstr  ( tempstr)  ; 

} 

else 

{ 

sprintf(tempstr,  "ki  %.3f  kf  %.3f', 

ksubi[stopcount] ,  ksubfjstopcount] ) : 


objreplace(testtag) ; 
charstr  (tempstr); 

} 

closeobj(); 

callobj(mapobj); 

/*  EDIT  GUAGES  */ 

sprintf(tempstr,  "^d",  (distance/ LAPD  1ST)  -I-  1); 

editobj  (gauges); 
objreplace(cmdvelocitytag); 

rectfi(CMDX,  CMDY,  CMDX  +  50,  CMDY  +  2  *  cmdvelocity); 
objreplace(carvelocity  tag)  ; 

rectfi(CARVELX,  CARVELY,  CARVELX  +  50, 

(int)(CARVELY  +  2  *  velocity)); 
objreplace(brakepositiontag) ; 

rectfi(BRAKEX,  BRAKEY,  BRAKEX  +  50,  BRAKEY  -  accelbrake); 

objreplace(  laptag) ; 

charstr  ( tempstr ) ; 

objreplace(thoutag); 

charstr(thouc): 

objreplace(hundredtag) ; 

charstr(hundc); 

objreplace(tentag); 

charstr(tenc); 

objreplace(unittag) ; 

charstr(unitc); 

switch(condition) 

{ 

case  AUTOPILOT:  objreplace(modeinserttag); 
charstr("Q"): 
objreplace(modetag) ; 

charstr  ( ”  AutoPilot " ) ; 

cmov2i(LAPX  -  26.  LAPY  -  72): 

charstr("  "); 

closeobj(); 

break; 

case  CruiseDrSteer.objreplace(modeinserttag); 
charstr("C"); 
objreplace(modetag) ; 
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case 


case 


case 


case 


charstr(M Cruise  Control"); 
cmov2i(LAPX  -  26,  LAPY  -  72); 
charstr("Driver  St  Cont"); 
closeobjQ; 
break; 

CruiseNavSteer:objreplace(modeinserttag); 
charstr("R"); 
objreplace(modetag) ; 
charstr("Cruise  Control"); 
cmov2i(LAPX  -  26,  LAPY  -  72); 
charstr("Nav  St  Cont"); 
closeobj(); 
break; 

ASteerDrSp:  objreplace(modeinserttag); 
charstr("S"); 
objreplace(modetag) ; 
charst  r  ( "  AutoS  teer  " ) ; 
cmov2i(LAPX  -  26,  LAPY  -  72); 
charstr(" Driver  Sp  Cont"); 
closeobj(); 
break; 

ASteerNSp:  objreplace(modeinserttag); 

charstr("A"); 
objreplace(modetag) ; 
charstr("  AutoSteer")  ; 
cmov2i(LAPX  -  26.  LAPY  -  72); 
charstr("Nav  Sp  Cont"); 
closeobj(); 
break; 

DrManual :  objreplace  ( modeinserttag)  ; 

charstr("D"); 
objreplace(modetag) ; 
charstr(" Driver  Manual"); 
cmov2i(LAPX  -  26,  LAPY  -  72); 
charstr("No  Nav  Cont"); 
closeobj(); 
breeLk; 


case  NavManual:  objreplace(modeinserttag); 


charstr("W"); 
objreplace(modetag) ; 
charstr("Nav  Manual"); 
cmov2i(LAPX  -  26,  LAPY  -  72); 
charstr ("Total  Control"); 
closeobjQ; 
break; 

case  DrSteerNavSp:  objreplace(modeinserttag); 
charstr  ("X”); 
objreplace(modetag) ; 
charstr  ("Driver  Steer"); 
cmov2i(LAPX  -  26,  LAPY  -  72); 
charstr ("Nav  Speed"); 
closeobjQ; 
break; 

case  NavSteerDrSp:  objreplace(modeinserttag); 
charstr("FM); 
objreplace(modetag) ; 
charstr("Nav  Steer"); 
cmov2i(LAPX  -  26,  LAPY  -  72); 
charstr  ("Driver  Speed"); 
closeobj(); 
break; 

} 

callobj  (gauges); 

checkkeybd(&notdone,  &recorddata,  &mode,  ^condition, 
&stopcount,  velocity); 

command  =  (mode  *  1000)  +  cmdvelocity; 

controlsignal  =  (mousex  *  1000)  -  accel  brake; 

if  (recorddata) 

{ 

data[datatime]  [DISTANCE]  =  rdistance; 

datajdatatime]  [VELOCITY]  =  velocity; 

cmdvelfdatatime]  =  cmdvelocity; 

brakedata[datatime]  =  -accel_brake; 

timedatajdatatime]  =  systemclock  -  starttime; 

if  (condition  ==  CruiseNavSteer  |  condition  ==  AUTOPILOT 


condition  ==  CruiseDrSteer) 

{ 

est_i[datatimej  =  ksubi(stopcount); 
est_f{datatime]  =  ksubf[stopcount]; 

} 

else 

{ 

est_i[datatime]  =  0.0; 
est_f[datatime]  =  0.0; 

} 

++datatime; 

} 

eke  starttime  =  times(&mytime); 
swapbuffers(); 

} 

close(car); 

/*  writes  data  to  a  file  */ 

savedata(data.  datatime.  brakedata,  timedata,  cmdvel); 

color(BLACK); 

clear(); 

swapbuffers(); 

clearQ; 

swapbuffers(); 

finish  (); 

gexit(); 

} 


^♦s******************************************** 


filename:  CRUISE.C 
author:  Michael  J.  Dolezai 
date:  May  20.  1987 


**•*♦  +  **  ********. a*******  ♦a.4***-***-*-**  tt*%:*:*  +  **:i** 


/ 


#  include  "const. h” 

# include  "vars.ext.h" 
# include  <math.h> 


cruisecontrol(systemclock,  a  max,  lightcolor) 
int  systemclock,  lightcolor; 


float  a  max; 

{ 

float  temp; 

switch(vision[eye]  [OBJECT]) 

{ 

case  SPEEDUMIT: 

if  ((distance  %  LAPDIST)  >=  vision[eye][LOCATIONj) 

{ 

cruisevelocity  =  visionjeye]  [SPEED]; 
lastremembered  =  visionfeye]  [SPEED]; 
if  (eye  <  numsights)  eye  =  eye  +  1; 

} 

else  cruisevelocity  =  lastremembered; 
break; 

case  STOPSIGN: 

PLANNED_DIST  =  vision[eye] [LOCATION]  -  distance; 
if  (PLANNED  DIST  >  0) 

{ 

temp  —  2  *  a  max  *  PLANNED  DIST: 
PLANNEDVELOCITY  =  3.6  *  (sqrt(temp)); 

} 

else  PLANNED  VELOCITY  -  0.0; 

if  (velocity  >  PLANNED  VELOCITY)  stopping  =  TR 

if  (velocity  ==  0.0)  clearintersection(systemclock); 

else  if  (stopping)  stopcar(); 

break; 

case  SIGNALLIGHT: 

PLANNEDDIST  =  vision[eye] [LOCATION]  -  distance; 
if  (PLANNED  DIST  >  0) 

{ 

temp  =  2  *  a  max  *  PLANNED_DIST; 

PLANNED  VELOCITY  =  3.6  *  (sqrt(temp)); 

} 

else  PLANNED  _VELOCITY  =  0.0: 
if  (velocity  >  PLANNED  VELOCITY)  stopping  =  TR 
if  (stopping)  signallight(lightcolor,  systemclock): 
break; 

default: 

break; 

}  /*  end  switch  */ 


} 


1^** **********************************  ********* 

filename:  BRAKE. C 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 

**********************************************  I 

#include  "vars.ext.h" 
stopcar() 

{ 

float  pervel,  perdist,  temp,  tempi; 
float  VELOCITYGAINFACTOR; 
float  POSITION  GAIN  FACTOR; 
float  ALPHA  —  0.60; 

VELOCITY  GAIN  FACTOR  =  4.289; 

POSITION  GAIN  FACTOR  =  4.840; 

/*  Used  to  calibrate  system 

ksubi[stopcount]  =  1.0; 

ksubffstopcount]  =  1.0; 

ksubefcyclecount]  —  0.0; 

ksubnfcyclecount]  =  0.0; 

7 

/*  what  does  the  driver  perceive  */ 
perdist  =  (ksubifstopcount]  -f  ksubejcyclecount])  *  (PLANNEDDIST); 

pervel  =  (ksubfjstopcount]  +  ksubn[cyclecount|)  *  velocity; 

if  (PLANNED  DIST  <  0)  PLANNED  DIST  =  0; 


accel  brake  =  (int) (-(POSITION  G AIN  F ACTOR* (PL ANNED  DIST-perdist))  + 

(VELOCITY  GAIN  FACTOR  * 

(PLANNED  VELOCITY  -  pervel))  -  ALPHA  *  ON); 

cruisevelocity  =  0; 

if  (accel_brake  >  0)  accel  brake  =  0; 
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if  (accel_brake  <  -200)  accel_brake  =  -200; 
++cyclecount; 

temp  =  ksubi(stopcount]  +  ksube[cyclecount  -  1); 
tempi  =  ksubffstopcount]  +  ksubn(cyclecount  -  l]; 
} 

j** Mi******************************************* 

filename:  SIGNAL. C 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 

*************************************  ********* j 

#include  "vars.ext.h" 

signallight(lightcolor,  systemclock) 

int  lightcolor,  systemclock; 

{ 

switch  (lightcolor) 

{ 

case  GREENLIGHT  : 

brakeposition  =  OFF; 

accelbrake  =  OFF; 

cruisevelocity  =  lastremembered; 

if  (eye  <  numsights)  eye  =  eye  +  1; 

firstcall  =  TRUE; 

stopping  =  FALSE; 

++stopcount; 
cyclecount  =  0; 
break: 

case  YELLOWLIGHT  : 

stopcar(); 

break; 

case  REDLIGHT  : 


stopcar(); 


} 


break; 


} 

/ 


********************************************** 


filename:  CLEAR. C 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 

*********:M***********************************  J 

^include  "vars.ext.h" 

clearintersection  (systemclock) 
int  systemclock; 

{ 

if  (firstcall) 

{ 

savedtime  =  systemclock; 
firstcall  =  FALSE; 

> 

else  if  (systemclock  -  savedtime  >  120) 

{ 

brakeposition  =  OFF; 

accelbrake  =  OFF; 

firstcall  =  TRUE; 

stopping  =  FALSE; 

if  (eye  <  numsights)  eye  =  eye  +  1; 

cruisevelocity  =  last  remembered; 

++stopcount; 

cyclecount  =  0; 

} 

} 

j* ********************************************* 


filename:  MAPVIEW.C 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 

********************************************** 
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#  include  "gl.h" 

#include  "vars.ext.h" 

^include  "stdio.h" 

#include  "const. h" 
makethemapview  (mapobj ) 

Object  *mapobj; 

{ 

int  i;  /*  loop  control  */ 

mapcolor(DIMGREEN,  0,  110,  0); 
mapcoIor(DIMYELLOW,  170,  170,  0); 
mapcolor(DIMRED.  110,  0,  0); 
mapcolor(LIGHTBLUE,  0,  255,  255); 

*  mapobj  =  genobj(); 
makeobj  ( *  mapobj ) ; 

pushmatrix();  /*  save  the  stack  */ 

pushviewport();  /*  save  the  viewpoet  *  f 

viewport(0,  767,  0,  767);  /*  reset  the  viewport  */ 

/*  coordinate  system  set  to  match  the 
coordinates  fo  the  road.  * / 

ortho2(- 108.0,  660.0,  -184.0,  584.0); 

/*  fill  the  background  */ 

color(LIGHTBLUE); 
rectf(-108.0,  -184.0,  660.0,  584.0); 
color(BLACK); 

/*  Draw  the  straight  roadlengths  */ 
color(BLACK); 

rectf(-12.0,  0.0,  4.0,  400.0);  /*  Length  #1  */ 

rectf(76.0,  472.0,  476.0,  488.0);  /*  Length  #2  */ 

rectf(548.0.  0.0,  564.0,  400.0);  /*  Length  #3  */ 

rectf(72.0,  -88.0,  476.0,  -72.0);  /*  Length  #4  */ 

/'  Draw  the  corners  */ 

color(BLACK); 

arcfi(76,  400,  88,  900,  1800);  /*  Draw  first  arc  */ 

color(LIGHTBLUE) ; 

arcfi(76,  400,  71,  900,  1800);  /*  Backfill  the  offroad  area  */ 

color(BLACK); 

arcf(476.0,  400.0,  88.0,  0,  900);  /*  Draw  second  arc  *  j 


color(LIGHTBLUE) ; 

arcf(476.0,  400.0,  71.0,  0,  900);  /*  Backfill  the  offroad  area  */ 


color(BLACK); 

arcf(476.0,  0.0,  88.0,  2700,  0); 

color(LIGHTBLUE); 

&rcf(476.0,  0.0,  71.0,  2700,  0); 

color  (BLACK); 

arcf(76.0,  0.0,  88.0,  1800,  2700); 
color(LIGHTBLUE) ; 
arcf(76.0,  0.0,  71.0,  1800,  2700); 

color(BLACK); 

rectf(-50.0,  92.0,  595.0,  108.0); 
rectf(-50.0,  292.0,  595.0,  308.0); 

cmov2i(16,  5); 
charstr  ( "START") ; 

stopsign(32.0,  113.0,  1); 
stopsign(519.0,  113.0,  3); 
stopsign(519.0,  316.0,  2); 

color(BLACK); 
rectfi(12,  314,  43,  394); 

redlighttag  =  gentag(); 
maketag(redlighttag) : 
color(DIMRED) ; 
circfi(27,  378,  10); 

yellowlighttag  =  gentag(); 
maketag(yellowlighttag) ; 
color(DIM  YELLOW); 
circfi(27.  353,  10); 


/*  Draw  third  arc  */ 

/*  Backfill  the  offroad  area  */ 

/*  Draw  fourth  arc  */ 

/*  Backfill  the  offroad  area  *  / 

/*  draw  the  first  crossroad  */ 

/*  draw  the  second  crossroad  */ 

/*  mark  the  start  */ 

/*  add  the  stopsigns  */ 

/*  make  a  signallight  */ 


greenlighttag  =  gentagQ; 
maketag(greenlighttag); 
color  (DIMGREEN); 
circfi(27,  328,  10); 

/*  mark  the  car  with  crosshair  * / 


color(WHITE); 


linewidth(2); 
cartag  =  gentag(); 
maketag(cartag) ; 
move2(0.0,0.0); 
draw2(0.0,  0.0); 
move2(0.0,0.0); 
draw2(0.0,  0.0); 
linewidth(l); 

/*  display  the  system  time  */ 

cmov2i(-50,  560); 
color(RED); 
timetag  =  gentag(); 
maketag(  timetag) ; 
charstr(”  "); 

/*  indicate  if  recording  data  */ 

cmov2i(250.  560); 
testtag  =  gentag(); 
maketag(testtag); 
charstr("  "): 

/*  return  the  state  of  the  machine.  */ 

pop  viewport  () ; 
popmatrixQ ; 
closeobj(); 

} 

y************************************************ 

stopsign() 

*********************************************«**/ 
stopsign(xpos,  ypos,  num) 

float  xpos,  ypos; 
int  num: 

{ 

char  tempstr[5]; 

Coord  vertice[l0][2]: 

float  width  =  42.0; 

float  temp  =  5  *  width/24; 

float  tempi  =  7  *  width/24; 

vertice[0][0]  =  xpos; 
vertice[0][lj  =  ypos; 
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verticefl]  [0]  =  xpos  4-  temp; 
vertice[l][l]  =  ypos; 

vertice[2][0]  =  xpos  4-  width/2; 
vertice[2][l]  =  ypos  +  tempi; 

vertice(3][0]  =  xpos  4-  width/2; 
vertice[3][l]  =  tempi  +  (2  *  temp)  4-  ypos; 

vertice[4][0]  =  xpos  4-  temp; 
vertice[4][l]  =  ypos  4-  width; 

vertice[5][0]  =  xpos  -  temp; 
vertice[5][l]  =  ypos  4-  width; 

vertice[6][0j  =  xpos  -  width/2; 
vertice(6][l]  =  tempi  4-  (2  *  temp)  4-  ypos; 

vertice[7][0]  =  xpos  -  width/2; 
vertice[7][l]  =  tempi  4-  ypos; 

vertice[8][0j  =  xpos  -  temp; 
vertice{8]|l]  =  ypos; 

/*  fill  the  sign  in  red  */ 

color(RED); 
polf2(9,  vertice); 

/*  outline  the  sign  */ 

color(  WHITE); 

poly2(9,  vertice); 

/*  put  stop  on  the  sign  */ 
cmov2(xpos  -  16,  ypos  +  16); 
charstr  ( "  STOP  " ) ; 

color(BLACK); 

cmov2(xpos  -  3.0,  ypos  4-  width  +  5.0); 
sprintf(tempstr.  M%d",  num); 
charstr  (tempstr); 
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author:  Michael  J.  Dolezal 
date:  May  20,  1987 

********************************************** 

^include  "const. h" 

#include  "vars.ext.h" 

makethegauges  (gauges) 

Object  *  gauges; 

{ 

*  gauges  =  genobjQ; 
makeobj  ( *  gauges) ; 


pushmatrixQ; 

pushviewport(); 

viewport(768.  1023.  0.  767); 
ortho2(0.0,  255.0.  0.0,  767.0); 

/*  fill  the  backcolor  */ 

color(  WHITE); 
rectf(0.0,  0.0,  255.0,  767.0); 

/*  label  the  gauge  */ 

color(BLACK); 
cmov2i(32,  730); 
charstr("COMMAND"); 
cmov2i(l59,  730); 
charstr("VEHICLE"): 
cmov2i(40,  714); 
charstr  ( "SPEED  " )  ; 
cmov2i(l55,  714); 
charstr("VELOCITY"); 

/*  draw  the  command  speed  gauge 

color(GREEN): 

cmdvelocitytag  =  gentag(); 

maketag(cmdvelocitytag); 

rectfi(CMDX,  CMDY,  CMDX  +  50,  CMDY); 

scalegauge(CMDX,  CMDY); 

/*  draw  the  car  velocity  gauge  */ 

color(GREEN); 
carvelocitytag  =  gentag(); 
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maketag(carvelocitytag) ; 

rectfi(CARVELX,  CARVELY,  CARVELX  4-  50,  CARVELY); 
scalegauge(CARVELX,  CARVELY); 

/*  draw  the  brake  pressure  gauge  *  / 

color  (BLACK); 
cmov2i(41,  470); 
charstr  ("BRAKE"); 
cmov2i(28,  454); 
charstr  ( "PRESSURE  " ) ; 

color(RED); 

brakepositiontag  =  gentagQ; 
maketag(brakepositiontag) ; 

rectfi(BRAKEX,  BRAKE Y,  BRAKEX  +  50,  BRAKEY); 
scalegauge(BRAKEX,  BRAKEY); 

/*  draw  the  distance  indicator  */ 

color(BLACK); 
cmov2i(177,  470); 
charstr("LAP"); 
cmov2i(155,  454); 
charstr  ("DISTANCE"); 

/*  outline  the  box  */ 

linewidth{2); 

recti(LAPX,  LAPY,  LAPX  4-  80,  LAPY  4-  60); 
linewidth(l); 

cmov2i(LAPX  4  35,  LAPY  4  35); 
laptag  =  gentagQ; 
maketag(laptag); 
charstr("l"); 

cmov2i(LAPX  4-  9,  LAPY  4  16); 
thoutag  =  gentagQ; 
maketag  ( thoutag) : 
charstr("0"): 

cmov2i(LAPX  4  27,  LAPY  4  16); 
hundredtag  =  gentagQ; 
maketag(hundredtag); 
charstr  ("0"): 

cmov2i(LAPX  4  45,  LAPY  4  16); 
tentag  =  gentagQ; 


maketag(tentag) ; 
charstr("0"); 

cmov2i(LAPX  +  63,  LAPY  +  16); 
unittag  =  gentagQ; 
maketag(unittag) ; 
charstr("0"); 

/*  set  up  the  mode  indicator  *  j 
cmov2i(LAPX  -  8,  LAPY  -  40); 
charstr("Mode:  "); 
color(RED); 

modeinserttag  =  gentag(); 
maketag(modeinserttag) ; 
charstr("D"); 

cmov2i(LAPX  -  26,  LAPY  -  56); 
color(RED); 
modetag  —  gentag(); 
maketag(modetag) ; 
charstr( "Driver  Manual"); 
cmov2i(LAPX  -  26,  LAPY  -  72); 
charstr("No  Nav  Cont"); 

color  (BLACK); 

/*  Display  help  information  */ 

cmov2i(168,  290); 
charstr("MOUSE"); 

cmov2i(155,  274); 
charstr  ( "  Steering") ; 

cmov2i(155,  239); 
charstr("Brakes"); 

/*  draw  a  direction  arrow  for  left /right  and  up /down  */ 

linewidth(2): 

move2i(155,  261); 

draw2i(225,  261): 

move2i(165,  266); 
draw2i(155,  261); 


move2i(165,  256); 
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draw2i(155,  261); 

move2i(215,  266); 
draw2i(225,  261); 

move2i(215,  256); 
draw2i(225,  261); 


move2i(225,  250); 
draw2i(225,  205); 

move2i(220,  215); 
draw2i(225,  205); 

move2i(230,  215); 
draw2i(225,  205); 

move2i(220,  240); 
draw2i(225,  250); 

move2i(230,  240); 
draw2i(225,  250); 

linewidth(l): 

cmov2i(65,  214); 

charstr ( ” KE YBD  CONTROLS”); 

cmov2i(30.  194); 
charstr  ("Q:  AutoPilot"); 

cmov2i(30,  174); 
charstr(”C:  Cruise,  Dr  Steer”); 

cmov2i(30.  154): 

charstr("R:  Cruise,  Nav  Steer”); 

cmov2i(30,  134); 

charstr(”S:  AutoSt,  Dr  Speed”); 

cmov2i(30,  114); 

charstr(”A:  AutoSt,  Nav  Speed"); 
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cmov2i(30,  94); 
charstr("D:  Driver  Control"); 


cmov2i(30.  74); 
charstr("W:  Nav  Control"); 

cmov2i(30,  54); 

charstr("X:  Dr  Steer,  Nav  Sp"); 
cmov2i(30,  34); 

charstr("F:  Nav  Steer,  Dr  Sp"); 

cmov2i(30.  14); 
charstr("E:  Exit"); 

popviewport(); 

popmatrix(); 

closeobj(): 

} 

/♦****= i.**************************************** 

scalegaugeQ; 

************************ **********************/ 

scalegauge(basex,  basey) 
int  basex,  basey; 

{ 

char  tempstr[lO]; 

int  i; 

/*  outline  the  gauge  */ 

linewidth(2); 

color(BLACK); 

recti(basex.  basey.  basex  +  50,  basey  4-  200); 
linewidth(l): 

/*  calibrate  the  gauge  */ 
for  (i  =  10:  i  <.  100:  i  =  i  -+  10) 

{ 

move2i (basex,  basey  +  2  *  i); 
draw2i(basex  +  13,  basey  +  2  *  i); 

move2i(basex  +  37,  basey  +  2  *  i); 

draw2i(basex  +  50,  basey  +  2  *  i); 

cmov2i(basex  +  16,  basey  +  (2  *  i)  -  4); 

sprintf(tempstr,  "%d",  i); 
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charstr(tempstr) ; 

} 

}  /’  scalegauge()  */ 


filename:  MOUSE. C 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 


# include  "const. h" 

# include  "vars.ext.h" 

mousespeedinput(cmdvelocity,  distance,  eye,  numsights,  lastremembered, 
brakeposition,  accel  brake) 

int  ’cmdvelocity,  ’distance,  ’eye,  ’numsights,  *  lastremembered, 
’brakeposition,  *  accel  brake: 

{ 

if  (getbutton(MOUSEl)) 

{ 

*cmdvelocity  =  ’cmdvelocity  +  SPEEDINC; 
if  (’cmdvelocity  >  100) 

{ 

’cmdvelocity  =  100; 

} 

} 

if  (getbutton(MOUSE2))  /*  decrease  speed  */ 

{ 

’cmdvelocity  =  ’cmdvelocity  -  SPEEDINC; 
if  (’cmdvelocity  <  0)  ’cmdvelocity  =  0; 

} 

if  (’distance  %  LAPD1ST  >  vision[’eye][LOCATION)) 

{ 

if  (vision  j  "eve]  [OBJECT]  ==  SPEEDLIMIT) 
’lastremembered  =  vision(*eye][SPEED]; 
if  (’eye  <  ’numsights)  ’eye  =  ’eye  +  1; 

} 

’brakeposition  =  (getvaluator(MOUSEY))/2; 
if  (’brakeposition  <  0)  ’brakeposition  =  0; 

’accel  brake  =  -(’brakeposition); 


y********************************************** 


filename:  NETV.C 
author:  James  Manley 
modified  by:  Michael  Zyda 
date:  April  29,  1987 

********************************************** 


r 

This  is  file  netV.c 

as  modified  by  M.  Zyda,  29  April  1987 


This  segment,  when  linked  into  a  program  on  a  computer  with  a  UNIX  4.2  BSD 
operating  system,  will  allow  the  program  to  communicate  with  programs 
executing  on  other  computer  systems  over  an  Internet  network. 
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#define  TRUE  1 

/*  include  files  for  UNIX  4.2  BSD  */ 

^include  <sys/types.h> 

#  include  <sys/socket.h> 

# include  <netinet/in.h> 

#include  <bsd/netdb.h> 

/****»**«************************************************** 

The  connect  serverfremote  client_name,  port_number)  function  performs 
the  actions  required  to  connect  a  server  system  to  a  remote  client  system 


|  *  .a  *  •«  *  «  * 
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*  «  *  a********************************************* 
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int  connect  server(remote_client  name,  port  number) 


/*  name  and  port  number  of  the  remote  client  system  */ 

char  remote  client  _name[]; 
int  port  number; 
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/*  pointer  to  the  remote  client  system’s  name  */ 
char  *ptr_client_name; 

/*  local  socket  number  * / 
int  local  server  socket; 

/*  function  that  opens  a  socket  *  f 

int  socket(); 

/*  function  that  accepts  a  connection  from  a  remote  client 
socket  */ 

int  accept(); 

/*  socket  number  of  the  remote  client  system  */ 
int  remote  client  socket; 

/*  protocol  and  address  data  structure  specified  for  the 
socket  */ 

static  struct  sockaddr  in  address  =  {  AF_INET  }; 

/*  address  of  the  remote  client  system  */ 

long  remote  client  address: 

/*  port  number  of  the  remote  client  system  */ 

short  remote  client  port; 

/*  size  of  the  address  data  structure  of  the  remote  client 
system  '/ 

int  address  size; 

/*  begin  the  process  of  attempting  to  connect  to  the 
remote  client  system  */ 

/*  get  a  pointer  to  the  remote  client  system’s  name  */ 
ptr  client  name  =  &remote_client_name[0]; 


/*  convert  the  remote  client  system  name  to  its  address  '  / 

remote  client  address  —  (long)gethostbyname(&ptr  client  name); 

/*  initialize  the  remote  client  port  number  above  the 
system  reserved  ports  */ 

remoteclientport  =  IPPORT  RESERVED  +  1; 

/*  add  the  remote  client  port  number  to  the  number  of 
reserved  ports  */ 

remote _client  port  =  remote _client  port  +  port  number; 

/*  initialize  the  remote  client  socket  number  to  an 
invalid  value  */ 

remote  client  socket  =  -1; 

/*  remote  client  system  address  family  (Internet  in  this 
case)  */ 

address  .sin  family  =  AF  INET  ; 

/*  place  the  remote  client  port  number  into  the  address 
data  structure  */ 

address.sin  port  =  remote  client  port; 

/*  put  the  port  number  in  network  byte  order  *7 

address. sin  port  =  htons(address.sin  port); 

/*  place  the  remote  client  system's  address  in  the  address 
•  data  structure  */ 

address. sin  addr.s  addr  =  remote  client  address; 

/*  find  number  of  bytes  in  the  remote  client  address  * / 
address  size  =  sizeof(remote  client  address); 


/*  attempt  to  open  a  local  socket  */ 


local  server  socket  =  socket(AF_INET,SOCK_STREAM,0); 
if  (local  server  socket  <  0) 

{ 

/*  the  server  couldn’t  open  a  local  socket  */ 

penor("Server  couldn’t  open  a  local  socket:”); 

} 

else 

{ 

if(bind(local  server  socket,  (caddr_t)&address, 
sizeof( address))  <  0) 

{ 

perror(" Server  couldn’t  bind  address  to  local  socket:  ”); 

} 

/*  set  the  maximum  number  of  remote  client  systems  to 
be  connected  to  *  / 

listen(loral  server  socket,5); 

printf(" Server  waiting  to  connect  to  %s\n". remote  client  name); 

/*  attempt  to  accept  a  connection  */ 

remote  client  socket  =  accept  (localserversocket,  ^address, 

&  address  size); 

if  (remote  client  socket  <  0) 

{ 

/*  an  error  occurred  in  the  server  attempting  to 
accept  a  connection  from  remote  client  system  */ 

perror( "Server  couldn’t  accept  a  connection 
from  the  remote  client  system  :"); 
close) local  server  socket); 

} 

}  /*  end  else  local  server  socket  >=  0  */ 

/*  return  the  socket  number  of  the  remote  client  system  *  j 

retumfremote  client  socket); 

}  /*  end  of  function  connect  server()  */ 


*********************************************************** 


The  connect  client  (remote  server  name  port_number)  function  performs 
all  the  actions  required  to  connect  a  client  system  to  a  remote  server 
system 

******  ***************************************************** ^ 

int  connect_client(remote_server_name,  port_number) 

/*  name  and  port  number  of  the  remote  server  system  */ 

char  remote  _server_name[j; 
int  port  number; 


/*  pointer  to  the  name  of  the  remote  server  system  */ 


char  *ptr  server  name; 


/*  local  socket  number  */ 


int  local  client  socket; 


int  socket(); 


int  connect(); 


/*  function  that  opens  a  socket  */ 


/*  function  that  connects  local  socket  to  remote  server 
socket  *1 


/*  the  socket  number  on  the  remote  server  system  */ 


int  remote  server  socket; 

f*  the  protocol  and  address  data  structure  specified  for 
the  socket  *  j 

static  struct  sockaddr  in  address  =  {  AF  INET  }; 
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/*  address  of  the  remote  server  system  */ 
struct  hostent  *  remote  server  address: 

/*  port  number  of  remote  system  */ 

short  remoteserverjport; 

/*  begin  the  process  of  attempting  to  connect  to  the 
remote  server  system  */ 

/*  establish  ptr  to  the  remote  server  name  */ 

ptrservername  =  <&remote_server  _name[0] ; 

/*  convert  the  name  of  the  remote  server  system  to  an 
address  */ 

remote  server  address  =  gethostbyname(ptr  server  name): 

/*  clear  out  the  address  structure  */ 

bzero((char  *)& address,  sizeof(address)); 

/*  copy  the  remote  server  address  structure  into  the 
address  structure  */ 

bcopy(remote_server  address->h  addr, 

(char  *)&address.sin_addr, 

remote_server  address- >h  length): 

j*  initialize  remote  server  port  number  above  the  system 
reserved  ports  */ 

remote  server  port  =  IPPORT  RESERVED  +  1: 

/*  add  the  user's  remote  server  port  number  to  the  number 
of  reserved  ports  */ 

remote  server  port  =  remote  server  port  +  port  number; 

/*  remote  server  system  address  family(Internet  in  this 


address  .sin  family  =  AFINET: 

/*  place  the  remote  server  port  number  into  the  address 
structure  */ 

address  .sinport  =  remoteserverport; 

/*  put  the  port  number  in  network  byte  order  * / 
address. sinport  =  htons(address.sin_port); 

/*  attempt  to  obtain  a  local  socket  */ 


localclientsocket  =  socket  (AF_INET,  SOCK  STREAM,  0); 

if(local_client_socket  <  0) 

{ 


/*  the  client  couldn’t  open  a  local  socket  */ 

perror( "Client  couldn’t  open  a  local  socket:  "); 

} 

else 

{ 


/*  place  Internet  address  family  type  in  address 
structure  */ 

address.sin  family  =  AF  INET: 

/*  attempt  to  connect  local  client  socket  to  remote 
server  socket  */ 
remoteserversocket  = 

connect(local  client  socket,  (caddr  t)&address, 

sizeof(address)); 

if( remote  server  socket  <  0) 

{ 


/*  an  error  occurred  in  attempting  to  connect  to 
the  remote  server  socket  */ 
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perror("  Client  couldn’t  connect  to  the  remote  server  socket:  "); 
c  lose  ( local  _c  lient  _socket ) ; 

} 


else 


{ 


/*  successfully  connected  to  the  remote  server 
system  */ 

printf( "Connection  established  with  %s.\n", remote  server  name); 

} 

}  /*  end  else  socket  >=  0  */ 

/*  return  the  socket  number  of  the  local  client  system  */ 
retum(localclientsocket); 

}  /*  end  of  funcition  connect  client  ()  */ 

/*********************************+*  *********************** 

function  write_immediate(socket_number,buffer,nbytes)  writes  to  the 
network  connection  by  forking  a  child  process  which  actually  performs  the 
write  operation. 

******************************************* ***************/ 

int  write  immediate  (socket  number,  buffer,  nbytes) 

/*  socket  number  to  be  written  */ 

int  socket  number; 

/*  buffer  of  bytes  to  be  written  */ 

char  bufferfj; 

/*  the  number  of  bytes  to  be  written  *  / 


long  nbytes; 


/*  function  which  initiates  a  child  process  */ 

int  fork(); 

/*  value  returned  from  routine  fork()  */ 

int  forkval; 

/*  initiate  a  child  process  which  will  perform  the  write 
operation  */ 

forkval  =  forkQ; 

/*  determine  whether  a  child  process  was  successfully 
started  */ 

if(forkval  ==  0) 

{ 

/*  attempt  to  perform  the  write  operation  */ 

while(write(socket  number,buffer,nbvtes)  !=  nbvtes) 

{ 

/*  attempt  to  write  the  buffer  contents  */ 


/*  terminate  the  child  process  after  the  buffer  is 
successfully  written  */ 


exit(l); 

} 


/*  an  error  occurred  in  starting  the  child  process  */ 


{ 

perror("Error  occurred  while  attempting 

to  fork  a  write- immediate  process:  "); 


retum(-l); 

} 


/*  return  an  error  value  to  the  application  */ 


filename:  CHECKKEY.C 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 


^include  "const. h" 
i  include  "device.h" 
f include  "vars.ext.h" 

checkkevbdfptnotdone.  ptrecorddata.  ptmode,  ptcondition. 
ptstopcount,  velocity) 

Boolean  *ptnotdone,  *ptrecorddata; 
int  *ptmode,  *  ptcondition,  ^ptstopcount; 
float  velocity; 

{ 

keypressed  =  NULL; 

♦ptmode  =  *ptcondition: 

if  (qtestQ) 

{ 

qr  ead  ( &k  ey  pressed ) ; 
switch(kevpressed) 


case  ’q’: 

case  ’Q’:  if  (velocity  >  3.0) 

{ 

*ptmode  =  AUTOPILOT; 

} 

break; 

/*  Cruise  cont  and  driver  steer  */ 


case  c  : 

case  ’C’:  if  (*ptmode  ==  ASteerNSp  ||  *ptmode 

{ 

*ptmode  =  AUTOPILOT: 

} 

else  *ptmode  =  CruiseDr Steer: 
break; 


—  ASteerDrSp) 


/*  Cruise  cont  and  remote  steer  */ 


case  V: 


case  ’R!:  if  (*ptmode  ==  ASteerNSp  ||  *ptmode  =  =  ASteerDrSp) 

{  - 

*ptmode  =  AUTOPILOT; 

} 

else  *ptmode  =  CruiseNav Steer; 
break; 

/*  Auto  speed  and  driver  speed  */ 

case  's’: 

case  ’S’:  if  (velocity  >  3.0) 

{  / 

if  (*ptmode  ===  CruiseNavSteer  |j 
*ptmode  ==  CruiseDrSteer) 

{ 

*ptmode  =  AUTOPILOT; 

} 

else  *ptmode  =  ASteerDrSp; 

} 

break: 


case  ’a’: 


/*  Auto  speed  and  remote  steer  */ 


case  ’A’:  if  (velocity  >  3.0) 

{ 

if  (*ptmode  ==  CruiseNavSteer 
'ptmode  ==  CruiseDrSteer) 

{ 

*ptmode  =  AUTOPILOT: 

} 

else  *ptmode  =  ASteerNSp; 

} 

break; 


/*  All  remote  manual  control  */ 
case  ’w': 

case  ’W’:  *ptmode  =  NavManual; 
break; 

case  'd‘: 

case  ’D’:  *ptmode  =  DrManual; 
break; 

case  ’x’: 

case  ’X’:  *ptmode  =  DrSteerNavSp; 
break; 

case  ’f: 

case  ’F’:  *ptmode  =  NavSteerDrSp; 
break; 


case  ’E’:  *ptnotdone  =  FALSE; 
break; 

case  Y: 

case  ’T”:  if  (*ptrecorddata)  *ptrecorddata 
else  *ptrecorddata  =  TRUE; 
break; 

} 


*ptcondition  =  *ptmode; 

}  /*  checkkeybd  */ 

y********************************************** 

filename:  SAVEDATA.C 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 

*********************  *************************  j 

#include  "vars.ext.h" 

#include  "stdio.h" 

#include  "const. h" 

savedata(data,  datatime,  brakedata,  timedata,cmdvel) 


FALSE; 


float  data[][2]; 
int  datatime; 
int  brakedataQ; 
int  timedataj]; 
int  cmdvel[]; 

{ 

FILE  *fopen(),  *fp; 
int  i; 

fp  =  fopen(,,test,,,  "w"); 

for  (i  =  0;  i  <  datatime;  ++i) 

{ 

fprintf(fp,  "%d  %d  %.3f  %.3f  %d  %d  %.3f  %.3f\n",  i,  cmdvel(i], 
data[i]  [DISTANCE], 

dataji] [VELOCITY],  brakedata[i],  timedatafi],  est_i[i], 
est_f]ij); 

} 

close(fp); 

} 

I  **************************************  ******** 

filename:  GENERATE.C 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 

**********************************************  I 

^include  "vars.ext.h" 

#include  "const. h" 

float  gaussiangenerator() 

{ 

float  temp; 
int  i: 

long  float  randomnums[l2j: 
long  float  drand48(); 
long  float  sum  =  0.0; 
for  (i  =  0;  i  <=  11;  -f+i) 

{ 

randomnums[i]  =  (0.2  *  drand48())  -  0.1; 
sum  =  sum  +  randomnums[i]; 

} 


temp  =  (sum/2.00)  +  1.0: 
ret  urn  (temp); 

} 

^*  +  *»*******«**************»**»»*<.»*»*»*>«(  **** 

filename:  LOADINTARRAY.C 
author:  Michael  J.  Dolezal 
date:  May  20.  1987 

******************************** * ******* ****** / 

#include  "vars.ext.h" 
loadintarray() 

{ 

if  ((fp  =  fopen( "vision. h'',,,r,'))  ==NULL) 

{ 

printf(” Cannot  see  into  vision.h."); 
retum(-l); 

} 

else 

{ 

for  (eye  =  0:  !feof(fp);  ++eye) 

{ 

fscanf(fp,  ”%d  %d  %d'\  &vision[eye] [LOCATION], 

& vision  [eye]  (OB  JE  CT] ,  ^vision  [eye]  [SPEED] ) ; 
if  (eye  ==  99) 

{ 

printf( "Vision  array  is  full,  increase  size  please,  n"): 
break; 

} 

} 

} 

numsights  =  --eye;  /*  number  of  items  in  vision  file  *  j 

eye  =  0; 

} 

****************************** ************* **»  j 

filename:  WELCOME. C 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 
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***S***X******«*********  *♦*♦*»**»♦«»***♦**!«***  ^ 

#include  "const. h" 

^include  "vars.ext.h" 

static  int  parray[4)[2]  =  { {275,600 }. {250.625}, { 275.625 }, {300.600}}: 
static  int  parrayl[4j[2]  =  {{275,475},{250,500},{275,500},{300,475}}; 

/**************************.****»******** ******»***,***»******« 
WELCOME  DISPLAY 

*.****t**^t**:x*rif**tti*t*********.ic*rr***********xr****r***»**x*  I 

welcome() 

{ 

color(  YELLOW); 
clear  (); 

color  (BLUE); 

rectfi(200, 625,300,700); 
rectfi(200,600,225,625); 
polf2i(4,parray); 

rectfi(325, 600,425, 700) ; 
rectfi(450, 600,550, 700); 
rectfi(575, 600,675, 700); 
polf2  i  ( 4 ,  parr  ay  1 ) ; 

rectfi(200,475,225,500); 
rectfi(200,500,300,575); 
rectfi(325,475,425,575); 
rectfi(450,475,550,500); 
rectfi(450,500.475,575); 
rectfi(575.475.675.500); 
rectfi(  575,500,600,575); 
rectfi(700, 525, 800,575); 
rectfi(737,475,762,525); 

color  (YELLOW); 

rectfi(225,650,275,675); 

140 


S 


L 


rectfi(350, 625,400,675); 
rectfi(475,600,525.625); 
rectfi(475, 650, 525,675); 
rectfi(575, 625,600,675); 
rec  tfi  (625 ,625 ,650 ,67 5 ) ; 
rectfi(225, 525,275,550); 
rectfij  350, 525,400, 550); 
rectfi(350, 475,400, 500); 
rectfij  725, 550, 775, 575); 

color  (MAGENTA); 

cmov2i(200,350); 

charstr("Welcome  to  the  world  of  ROAD  RALLY,  a  simulation"); 
cmov2i  (200,325) ; 

charstr("of  a  car  on  a  road  controlled  by  a  remote  driver"); 
cmov2i(200,300); 

charstr("(a  control  program  executing  on  another  processor)."); 
cmov2i(200,275); 

charstr("To  exit  the  program  press  all  three  mouse  buttons"); 
cmov2i(200,250); 

charstr(”at  the  same  time.  Files  are  now  loading  and  the"); 
cmov2i  (200,225); 

charstr("demonstration  will  begin  shortly.  "); 

linewidth(5); 

cmov2i(200,150): 

charstr("Car  simulation  by:  Tan  Chiam  Huat  and  Mike  Whiting"); 
cmov2i(200,  125); 

charstr("Driver  simulation  and  networking  by:  Mike  Dolezal"): 

linewidth(l); 

swapbuffers(); 

}  /*  welcome  */ 

/**********«*********************************** 


filename:  CONST.H 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 


finclude  "gl.h" 

# include  "device.h" 
f include  "stdio.h" 

/*  defines  the  light  conditions  *  / 

# define  REDLIGHT  1 

# define  YELLOWLIGHT  2 

# define  GREENLIGHT  3 

/*  used  to  define  braking  conditions  * / 

# define  GFF  0 

fdefine  ON  200 

fdefine  SPEEDLIMIT  4 

# define  STOPSIGN  5 

fdefine  SIGNALLIGHT  6 

fdefine  LOCATION  0 

# define  OBJECT  1 

fdefine  SPEED  2 

f define  MPS  TO  KMPH  3.6 

fdefine  DIMGREEN  9 

# define  DIMYELLOW  10 

fdefine  DIMRED  11 

f  define  LIGHTBLUE  12 

/*  next  6  constants  are  for  locating  guages  */ 


f define  BRAKEX 
fdefine  BRAKEY 
# define  CARVELX 
# define  CARVELY 
4 define  CMDX 
#  define  CMDY 
fdefine  LAPX 
fdefine  LAPY 
# define  DISTANCE 
# define  VELOCITY 
fdefine  SPEEDINC 
fdefine  LAPDIST 
f  define  DrManual 
#define  ASteerNSp 
fdefine  CruiseNavSteer 
# define  AUTOPILOT 
fdefine  CruiseDrSteer 
fdefine  ASteerDrSp 
fdefine  NavManual 
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# define  DrSteerNavSp 
^define  NavSteerDrSp 


filename:  VARS.H 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 


^include  "stdio.h" 

int  cmdvelocity  =0:  /*  commander 

int  cruisevelocity  =0:  /*  velocity  read 

int  distance:  f  distance  th< 

int  vision[l00][3];  /*  2-D  array  to 

int  eye  =0:  /*  loop  couni 

int  numsights: 

int  lastremembered  =  10;  /  ‘  the  driver 

speed  * / 

int  numpoints;  /*  number  of 

int  stopcount,  cydecount;  /*  control  varia 

random  r 

int  brakeposition  =  OFF; 

int  accel  brake  =0;  /*  accelerator 

int  savedtime  —  0; 

int  brakedata[3000| ;  /*  stores  test  c 

int  PLANNED  DIST: 
int  cmdvel[l000j: 

Boolean  stopping  =  FALSE: 

Boolean  firstcall  =  TRUE; 

float  velocity  =  0.0:  /  *  velocity  of  the  car  '/ 

float  brakingdist: 
float  PLANNED  VELOCITY; 
float  cx  =  0.0:  /*  car's  x  coo 

float  cy  —  0.0;  /*  car's  y  coo 

float  data[3000j[2);  /*  array  to  ston 

float  est  i[3000j;  /*  holds  ksubi 

float  est  f|3000j;  /*  holds  ksubf 

float  ksubi(l0],  ksubfjlO],  ksube{!50],  ksubn[l50j: 


/*  commanded  vehicle  velocity  */ 

/*  velocity  read  from  vision  file  */ 
j'  distance  the  car  has  traveled  ’/ 

/*  2-D  array  to  hold  vision  file  */ 

/  *  loop  counter  and  elements  in  vision  *  / 

/  ‘  the  driver  remembers  his  last  assigned 
speed  * / 

j*  number  of  points  in  roadmap  */ 

/*  control  variables  for  arrays  holding 
random  numbers  *  / 

/*  acceleration  due  to  braking  */ 

/*  stores  test  data  */ 


/*  car's  x  coordinate  */ 
/*  car's  y  coordinate  */ 
/*  array  to  store  data  */ 
/*  holds  ksubi  */ 

/*  holds  ksubf  ’/ 


-  *•  \  *.  v’  s 


FILE  *fopen(),  *fp; 


Tag  cartag,  green  light  tag,  yellowlighttag,  redlighttag; 

Tag  cmdvelocitytag,  carvelocitytag.  brakepositiontag; 

Tag  laptag,  modetag,  unittag,  tentag,  hundredtag,  thoutag; 

Tag  modeinserttag,  timetag,  testtag: 

Object  mapobj,  gauges; 

Device  keypressed; 

filename;  VARS. EXT. H 
author:  Michael  J.  Dolezal 
date:  May  20.  1987 

yn«**»t»l>«»«.*»**nt****t»*lt*t**<»**,.»,  *  *  *  * 

^include  "gl.h" 

*  include  "const. h" 

^include  "stdio.h" 

extern  int  cmdvelocity;  /*  commanded  vehicle  velocity  */ 

extern  int  cruisevelocity;  /*  read  from  vision  file  */ 

extern  int  distance;  /*  distance  the  car  has  traveled  *  / 

extern  int  vision[l00][3];  /*  2-D  array  to  hold  vision  file  */ 

extern  int  eye,  numsights;  /*  loop  counter  and  elements  in  vision  */ 

extern  int  l&stremembered;  /*  the  driver  remembers  his  last  assigned 

speed  */ 

extern  int  numpoints:  /*  number  of  points  in  roadmap  * / 

extern  int  stopcount,  cyclecount;  /*  control  variables  for  the  random 

number  arrays  */ 

extern  int  brakeposition; 
extern  int  accel  brake; 
extern  int  savedtime: 

extern  int  !)rakedatai3000l:  ''  stores  test  data  '/ 

extern  int  PLANNED  DIST; 

extern  Boolean  stopping; 
extern  Boolean  firstcall; 

extern  float  velocity;  /*  velocity  of  the  car  */ 
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SRCS 


OBJS 


=  navigator. c\ 
clear. c\ 
welcome.c\ 
generates  \ 
cruise.c  \ 
mouse. c\ 
checkkey.c\ 
savedata.c\ 
Ioadarray.c\ 
mapview.c\ 
gauges.c\ 
brake.c\ 
signal. c\ 
netV.c 

=  navigator.o\ 
clear.o\ 
welcome. o\ 
generate.o\ 
cruise.o\ 
mouse.o\ 
checkkey.o\ 
savedata.o\ 
loadarray.o\ 
mapview.o\ 
gauges. o\ 
signal. o\ 
brake.o\ 
netV.o 


nav:  (OBJS)ec  -o  nav  (OBJS)  -Zf  -Zg  -lm  -g  -lbsd  -ldbm 
(OBJS)  :  const.h  .ps  12 


APPENDIX  B 


int  prevmousex  =  250; 
int  prevremotedriver 
int  samplinginterval 
int  old  sampling  cycle 
int  new_sampling  cycle; 
int  lightcolor  =  REDLIGHT 
int  cardriver; 
int  nbyte; 

int  connectserverQ; 
int  no  coord; 
int  where 
int  counter 
int  lap  —  0; 


=  250:  /*  previous  input  from  remote  driver  r / 
=  1; 

=  -1; 

/*  used  to  pass  signallight  to  driver 
/*  socket  to  the  local  client  system  */ 

/*  read/write  variable  */ 

I*  function  connecting  car  to  the  driver  * 


=  0: 
=  0: 


/*  counter  for  signal  light  timing 
/*  lap  counter  for  arctan  function 
int  i.  count,  unit,  ten,  hundred,  thousand,  no  of  round: 
int  mode  =0;  /*  current  operating  mode  */ 

int  status  =  0: 

int  condition  =0:  / 

int  brakeposition  =  0: 

int  accel  brake  =0:  / 

int  command  =  0; 


current  operating  mode  */ 
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acceleration  due  to  braking 
/■*  received  from  driver  '  j 
/*  temp  vars  to  minimize  function  calls 
int  statussize,  exsize,  czsize,  distancesize,  commandsize, 
controlsize,  velocitysize,  carstatsize; 


long  carstat  =0;  /*  used  to  send  the  velocity  and  the 

brakeposition  to  the  recorder  */ 

long  controlsignal  =0;  /*  steering  and  brake  info  received  from 

controller  */ 

float  cmdspeed  =  0.0: 

float  prediction  distance: 
float  tolerance  =  1.0; 

float  old  sigma  =  0.4: 

/*  used  to  correct  discontinous  arctangent  */ 
float  lastsigma  =  0.0: 

float  temp,  tempi,  tempvel; 
float  gx.  gv.  gz: 

char  thousandc(2j,  hundredc[2j.  tenc[2j.  unitc[2j: 

char  timecjlOj;  /*  Car  time  in  char  format  */ 

/*  System  clock  ’ / 

/*  For  clock  value  */ 


extern  long  time(); 
long  clocktime; 
char  *clockc; 


I  £1-4  »*|  «  4  a’t.gij-i 


Boolean  alarm 
Boolean  debug 
Boolean  notdone 


Dimension 

Dimension 

Dimension 

Dimension 

Dimension 

Dimension 

Dimension 


consumption 

crashdown 

fueldown 

headingdeg 

headingrad 

rdistance 

vd 


=  FALSE;  /*  Off  road  warning  flag  */ 

=  FALSE;  /*  Turn  off  debug  info  */ 

=  TRUE;  I*  Controls  program  termination  ‘ j 

=  1.0;  /*  Fuel  consumption  '  j 

=  0.0;  /*  Off- road  display  flag  */ 

=  0.0;  /*  Fuel  depleted  display  flag  */ 

=  0.0;  /*  Heading  in  degrees  */ 

=  0.0;  /*  Heading  in  radians  */ 

=  0.0;  /*  Distance  travelled  */ 

=  100.0;  /*  Viewing  distance  */ 

/*  Signal  Light  Setup  */ 


Dimension  timegreen 
Dimension  timeyellow 
Dimension  timered 

Coord  crashx  =  512.0; 
Coord  crashy  =  385.0; 
Coord  warnxl  =  212.0; 
Coord  warnx2  =  700.0; 
Coord  warny  =  385.0; 

Colorindex  colors[l]; 
short  nopixel  =  1; 

Coord  cx,  cy,  cz; 

Coord  rx,  ry,  rz; 

Coord  pz,  px; 


/*  X  viewport  coord  to  detect  off-road  */ 

/*  Y  viewport  coord  to  detect  off-road  */ 

/*  X  viewport  coord  to  warn  off-road  */ 

/*  X  viewport  coord  to  warn  off-road  */ 

j*  Y  viewport  coord  to  warn  off-road  *  j 

I*  Array  to  store  color  of  crash  spot  */ 

/*  No  of  pixel  to  detect  off-road  *  j 


/*  Current  viewing  point  */ 
/*  Reference  point  */ 

/*  Last  viewing  point  */ 


Object  terrainl.  odometer,  warning,  heading  meter; 
Object  speedometer,  fuel,  steerwheel; 

Object  signboard,  sky.  mountain; 

Object  road,  help,  gauges,  arrow,  house,  housel: 


/*  Initial  state  vector  of  the  automobile  *  j 
state_vector[l]  =  0.0;  /*  initial  z  coord  */ 

state_vector[2]  =  0.0;  /*  initial  x  coord  */ 

state_vector[3j  =  0.0;  /*  initial  velocity  */ 

state_vector[4j  =  0.0;  /*  initial  heading  */ 

cx  =  0.0; 
cy  =  3.0; 
cz  =  0.0; 
rx  =  0.0; 
ry  =  3.0; 
rz  =  -vd; 

/*  complete  function  calls  for  read/ writes  */ 

statussize  =  sizeof(status); 
exsize  =  sizeof(cx); 
czsize  =  sizeof(cz); 
distancesize  =  sizeof(rdistance); 
commandsize  =  sizeof(command); 
controlsize  =  sizeof(controlsignal); 
velocitysize  =  sizeof(tempvel); 
carstatsize  =  sizeof(carstat); 
count  =  0; 

unit  =  ten  =  hundred  =  thousand  =  0; 

l*  initialize  signal  lights  */ 

timegreen  =  (timegreen  *  20); 

timeyellow  =  (timeyellow  *  20)  +  timegreen; 

timered  =  (timered  *  20)  +  timeyellow; 

/*  initialize  the  workstation  */ 

ginit(); 

doublebuffer(); 

gconfig(); 

cursoff(); 

qdevice(KEYBD); 

viewport (0,  XMAXSCREEN,  0,  YMAXSCREEN); 
ortho2(0.0,  1023.0,  0.0,  767.0); 
blink(10.  CYAN,  255,  0,  0); 
bbox2i(5.  5,  0.  1023,  0,  767); 

I*  Colors  are  further  defined  in  const. h 
mapcolor (MOUNTAIN,  199,  123,  63); 
mapcolor (MOUNT AINl,  210,  150,  0); 
mapcolor  (FIELD,  5,  190,  20); 
mapcolor(SKY,  50,  8,  155); 
mapcolor(WARN,  125,  0,  0); 
mapcolor  (CHMWALLl,  118, 76,0); 
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mapcolor(CHMWALL2, 146, 114,0); 
mapcolor(  WINDOW  .0.14 1.205); 
mapcolor(SIDEROOF,188,50,14); 
mapcolor(FRAME,118,50,14); 
mapcolor  (WALL, 164, 11 1,0); 
mapcolor(SIDE  WALL, 146, 94,1); 
mapcolor(ROOF,148,50,14); 
mapcolor(DIMGREEN,0,  110,  0); 
mapcolor(DIM  YELLOW,  170,  170,  0); 
mapcoIor(DIMRED,  110,  0,  0); 
mapcolor(GRAY,  165,  165,165); 
mapcolor(ROOFl.l00.100,100); 
mapcolor(FRAMEl,0,60,60); 
mapcolor  (SIDE  W  ALLl  ,150,60,60) ; 
mapcolor  ( W  ALL  1 ,160,60.60) ; 
setvaluator(MOUSEX.  250,  0,  500); 
setvaluator(MOUSEY,  -10,  -10,  400); 
noise(MOUSEX.  10); 


/*  colors  for  signal  light  */ 


/*  Dark  Grey  */ 

/*  Light  Grey  */ 

/*  Light  Grey  */ 

/*  Pink  */ 

/*  set  the  system-  mouse  ’  / 


MAKE  ALL  THE  OBJECTS 

************************************************************* 

makethespeedometer(&speedometer); 
makeheading(&heading_meter) : 
makesteerwheel(&steerwheel) ; 
maketheodometer  (hodometer) ; 
maketerrainl(&terrainl); 
makewarning(&warning); 
maketheroad(&road) ; 
makehouse  1  ( &house  1 ) ; 
makehouse  ( &house)  ; 
makethesky  ( &sky ) ; 
makegauges  ( ^gauges ) ; 
makehelp(&help); 
makefuel(&fuel) ; 


welcome(); 

no  coord  =  loadarrayQ; 


/*  Display  the  introductory  image 
/*  Read  the  roadmap  */ 


/*  Initialize  the  buffers  */ 


color(BLACK); 
clear(); 
swapbuffersQ; 
clear  (); 
swapbuffers(); 

^************************************************************* 

MAIN  SIMULATION  LOOP 

*************************************************************/ 

while(TRUE) 

{ 

nbyte  =  read(cardriver,  ^command,  commandsize); 
nbyte  =  read(cardriver,  &controlsignal,  controlsize); 

remotedriver  =  controlsignal/1000; 
condition  =  commajid/1000; 

cmdspeed  =  (command  -  (condition  *  1000))/MPS_TO  KMPH; 

/*  adjust  velocity  for  acceleration  due  to  braking, 
time  is  one  cycle  * / 

state  vector[3]  =  state_vector[3]  +  (BRAKEGAIN  *  accel  brake); 
if  (state  vector[3]  <  0.0)  state_vector[3]  =  0.0; 

/*  counter  for  signal  light  color  */ 
counter  =  counter  4-  1: 

newsampling  cycle  =  count/sampling  interval: 

-M-count; 

pz  =  cz;  px  =  cx: 
clocktime  =  time((long  *)  0); 
clockc  =  ctime(&clocktime); 

/*  Sound  alarm  around  2m  before  off  the  road  '  / 
cmov2(warnxl,  warny); 
readpixels(nopixel,  colors); 

if  (colors(O)  !=  BLACK  &&  colors[0]  !=  WHITE  colors[0]  !=  YELLOW) 
alarm  =  TRUE; 
else  alarm  =  FALSE; 


if  (lalarm) 


{ 

cmov2(warnx2.  wamy); 
readpixels(nopixel,  colors); 

if  (colors(0]  !=  BLACK  kk  colors[0]  !=  WHITE  kk 
colors[0j  !=  YELLOW) 
alarm  =  TRUE; 
else  alarm  =  FALSE; 

} 


I*  Check  if  the  vehicle  is  off  the  road 
IMPT  :  Assume  road  surface  is  black 
and  surface  signs  are  white  or  yellow  centerline  */ 
cmov2(crashx,  crashy); 
readpixels(nopixel,  colors); 

if  (colors(O)  !=  BLACK  kk  colorsfO]  !=  WHITE  kk  colors[0]  !=  YELLOW) 
crashdown  =  -1000.0; 

rz  =  -  (vd*cos(state  vector[4j)  -f  state  vectorflj); 
rx  =  vd*sin(state  vector[4])  +  state  vector[2); 

/*  prevent  arctan  from  exploding  by  exceeding 
small  angle  assumption  when  speed  gets  slow  */ 
if  (state  _vector[3]  <  (10.0/MPS  TO  KMPH)) 

{ 

if  (condition  — =  ASteerDrSp)  condition  =  DrManual; 
if  (condition  — =  ASteerNSp)  condition  =  NavManual; 
if  (condition  ==  AUTOPILOT)  condition  =  CruiseDrSteer; 

} 

/*  compute  a  new  state  for  the  vehicle  statevectors.  ' j 
compute  new  state(condition); 

cz  =  -state_vector[l]; 
cx  —  state  vector[2j; 

/*  Check  if  keyboard  pressed.  */ 
checkkeybd(&notdone,  <t:debug,  A:start,  A'mode,  Arcondition); 

/*  combine  data  to  improve  efficiency  */ 
status  =  (notdone  *  100)  (lightcolor  *  10)  +  mode; 
tempvel  =  (state  vector[3]  *  MPS  TO  KMPH); 

/*  send  data  to  the  navigator  * / 
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nbyte  =  write(cardriver,  &status,  statussize); 
nbyte  =  write(cardriver,  &tempvel,  velocitysize); 


if  (state _vector[3]  >  0) 

{ 

prediction  distance  =  state_vector[3]  *  prediction_time; 

r 

"where”  is  passed  to  find  subgoal  so  that  searching 
need  not  always  start  from  the  beginning  of  the  road. 

The  z  and  y  convention  in  the  graphics  system  is  reversed. 

Also  the  sign  is  going  in  the  opposite  direction.  So 
compensate  before  passing  into  find_subgoal. 

7 

where  =  find  subgoal(no_coord,  where,  tolerance, 

prediction_distance,  cx,  -cz,  px,  -pz,  0.0); 

} 

switch(condition) 

{ 

case  ASteerDrSp:  if  (old  sampling  cycle  <  new  sampling  cycle) 

{ 

old  sampling_cycle  =  newsamplingcycle; 
if  (where  <  0) 

{ 

/*  Stop  completely  and  remove  autopilot  */ 
state_vector[3]  =  0.0; 
speed  =  0.0; 
condition  —  DrManual; 

} 

else 

{ 

gx  =  roadmap[where][0]; 
gy  =  roadmap[where][l]; 
gz  =  roadmap  [where]  [2]; 

} 

} 

/*  Convention  difference:  Z-axis  in  graphics  is  Y-axis  in 
mathematical  model.  Also  Z-axis  is  negative  when  moving 
into  the  screen  which  therefore  must  be  converted  to 
positive  for  our  calculation.  */ 


temp  =  -cz; 
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sigma  =  atan2((gx-cx),(gy-temp)); 
if  (sigma  -  lastsigma  <  -  3.5) 

{ 

lap  =  1  +  (int)( (lastsigma  -  sigma  -  PI) / (2  ‘  PI)); 
sigma  =  sigma  4-  2  *  PI  *  lap; 
lastsigma  =  sigma; 

} 

else 

{ 

lastsigma  =  sigma; 

} 

sigma  dot  =  (sigma  -  old  sigma)/deltat; 
old  sigma  =  sigma; 
if  (getbutton(MOUSEl)) 

-  { 

if  (speed  <  (98.0/MPSTOKMPH)) 

{ 

start  =  FALSE: 

speed  =  speed  +  (speedinc/MPS  TO  KMPH); 

} 

else  speed  =  100.0/MPS_TO_KMPH;  /*  Top  Speed  */ 

} 

if  (getbutton(MOUSE2))  /*  decrease  speed  */ 

{ 

speed  =  speed  -  speedinc; 
if  (speed  <  0.0)  speed  =  0.0; 

} 

if  (getbutton(MOUSE3))  /*  decrease  speed  */ 

{ 

speed  =  0.0; 

} 

brakeposition  =  (getvaluator(MOUSEY))/2; 
if  (brakeposition  <  0)  brakeposition  =  0; 
accel  brake  =  -brakeposition; 

carstat  =  (brakeposition  *  1000)  +  (int) (speed); 

nbyte  =  write(cardriver,  &carstat.  carstatsize); 
break; 

AUTOPILOT: 

ASteerNSp:  if  (old  sampling  cycle  <  new  sampling  cycle) 


{ 

old  sampling  cycle  =  new  sampling  cycle; 
if  (where  <  0) 

/*  Stop  completely  and  remove  autopilot  / 
state  vector[3]  =  0.0; 
speed  =  0.0; 
condition  =  DrManual; 

} 

else 

{ 

gx  =  roadmap(where][0]; 
gy  =  roadmap(wherej(lj; 
gz  =  roadmap[where][2]; 

} 

} 

/*  Convention  difference:  Z-axis  in  graphics  is  Y-axis  in 
mathematical  model.  Also  Z-axis  is  negative  when  moving 
into  the  screen  which  therefore  must  be  converted  to 
positive  for  our  calculation.  ’/ 

temp  =  -cz; 

sigma  =  atan2((gx-cx),(gy-temp)); 
if  (sigma  -  lastsigma  <  -  3.5) 

lap  =  1  +  (int)( (lastsigma  -  sigma  -  PI)/(2  *  PI)); 
sigma  =  sigma  +  2  *  PI  *  lap; 
lastsigma  =  sigma; 

} 

else 

{ 

lastsigma  =  sigma: 

} 

sigma  dot  =  (sigma  -  old  sigma)/deltat; 
old  >igrna  =  sigma: 
speed  =  rrndspeed : 

accel  brake  =  -(controlsignal  -  t remotednver  ’  1000)); 

break ; 

/*  Nav  speed  and  Driver's  steering  */ 

case  DrSteerNavSp: 

/'  cruiserontrol  and  local  steering  */ 
case  CruiseDrSteer  mousex  =  get  valuator)  NIOVSEX) : 
cal  mousex  =  mousex  -  prev  mousex: 
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steer  wheel  angle  =  steer  wheel  angle  +  (float)  cal  mousex/200; 
prev  mo  use  x  =  mousex: 
speed  =  cmdspeed; 

accelbrake  =  -(controlsignal  -  (remotedriver  *  1000)); 

start  =  FALSE; 

break; 

/*  steering  and  speed  with  local  mouse  *  / 
case  DrManual:  mousex  =  getvaluator(MOUSEX); 
cal  mousex  =  mousex  -  prev  mousex; 

steer  wheel  angle  =  steer  wheel  angle  4-  (float)  cal  mousex/200; 
prev  mousex  =  mousex; 
if  (getbutton(MOl'SEl )) 

{ 

if  (t peed  <  (98.0/MPS  TO  KMPH)) 

{ 

speed  =  speed  +  (speedinc/MPS  TO  KMPH); 

} 

else  speed  =  100.0/MPS  TO  KMPH;  /*  Top  Speed  */ 

\ 

if  (getbutton(MCK'SE2))  /*  decrease  speed  */ 

{ 

speed  =  speed  -  speed  inc; 
if  (speed  <  0.0)  speed  =  0.0; 

} 

if  (getbutton(MOL'SE3))  /*  decrease  speed  */ 

{ 

speed  =  0.0; 

} 

brakeposition  =  (getvaluator(MOL'SEY))/2: 
if  (brakeposition  *  0)  brakeposition  =  0; 
accel  brake  =  -  brakeposition; 

carstat  =  (brakeposition  *  1000)  +  (int) (speed); 

nbyte  =  write(cardriver.  ircarstat,  carstatsize); 

start  =  FALSE; 
break; 


/*  steering  and  speed  with  mouse  on  remote  controller  ' 
/*  cruise  control  and  remote  steering  ’/ 
case  CruiseNavSteer. 

case  NavManual:  cal  mousex  -  remotedriver  -  prevremotedriver: 
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steer  wheel  angle  =  steer  wheel  angle  +  (float)  cal  mousex/200; 
prevremotedriver  =  remotedriver; 
speed  =  cmdspeed; 

accel  brake  =  -(controlsignal  -  (remotedriver  *  1000)); 

start  =  FALSE; 

break; 

case  NavSteerDrSp:  cal  mousex  =  remotedriver  -  prevremotedriver; 

steer  wheel  angle  =  steer  wheel_angle  +  (float)  cal  mousex/ 200; 
prevremotedriver  =  remotedriver; 
if  (getbutton(MOUSEl)) 

-  { 

if  (speed  <  (98.0/MPS  TO  KMPH)) 

{ 

speed  =  speed  +  (speedinc/MPS  TO  KMPH); 

} 

else  speed  =  100. 0/MPS  TO  KMPH;  /’  Top  Speed  '/ 

} 

if  (getbutton(MOUSE2))  /*  decrease  speed  */ 

{ 

speed  =  speed  -  speedinc; 
if  (speed  <  0.0)  speed  =  0.0; 

} 

if  (getbutton(MOUSE3))  /*  decrease  speed  *  / 

{ 

speed  =  0.0; 

} 

brakeposition  =  (getvaluator(MOUSEY))/2; 
if  (brakeposition  <  0)  brakeposition  =  0: 
accel  brake  =  -brakeposition; 
carstat  =  (brakeposition  *  1000)  4-  (int)(speed); 

nbyte  =  writefcardriver,  &carstat,  carstatsize); 

start  =  FALSE; 
break: 

}  /*  end  switch  */ 

/*  Clear  the  vehicle  window  */ 
viewport(0,  XMAXSCREEN.  385.  YMAXSCREEN). 
color(FIELD); 
clear(); 
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/*  Clear  the  display  panel  */ 
viewport(0.  XMAXSCREEN.  0.  380): 
color(  WHITE); 
clear(); 

/*  Reset  viewport  */ 

viewport(0,  XMAXSCREEN,  0,  YMAXSCREEN); 

/*  Calculate  distance  travelled  */ 

rdistance  =  rdistance+sqrt((cz-pz)*(cz-pz)-r(cx-px)*(cx-px)): 
distance  =  (int)  rdistance; 

nbyte  =  write(cardriver,  &cx,  exsize); 
nbyte  =  write(cardriver,  &cz,  czsize); 
nbyte  =  write(cardriver.  &:rdistance.  distancesize): 

thousand  =  distance/ 1000: 

hundred  =  (distance  -  thousand*  1000)/ 100: 

ten  =  (distance  -  hundred  '  100  -  thousand*  1000)/ 10: 

unit  =  distance  -  ten  *  10  -  hundred  *  100  -  thousand*  1000; 

if  (unit  ==  10)  {  unit  —  0;  ++ten;  } 
if  (ten  ==  10)  {  ten  =  0;  ++hundred;  } 
if  (hundred  ==  10)  {  hundred  =  0;  -f-+thousand:  } 
if  (thousand  ==  10)  thousand  =  0; 
spnntf(timec."°c5.2f", car  time); 
sprintf(thousandc."°^d", thousand); 
sprintf(hundredc."eed". hundred): 
spnntf(tenc.  "T d".tenj; 
spnntf(un<tc.'"7d".uniti--t-); 

/*  DISPLAY  HELP  PANEL  */ 

caliobj(help); 

•  EDIT  VKY  ' 

editobj(sky  i , 
objreplace  i  sky  look  t  ag ) ; 
lookat  ( cx.ry.cz.  rx.ry.rz. 0.0); 
closeobjl ) . 
callobjlsky ) 


/*  EDIT  TERRAIN  */ 


editobj(terrainl); 
objreplace(terrain  1  lookt ag) ; 

Iookat(cx,cy,cz,rx,ry.rz,0.0): 

closeobj(); 

c  alio  bj(  ter  rainl); 

/*  EDIT  ROAD  */ 

editobj(road); 
objreplace(roadlooktag); 
lookat(cx,  cy,  cz,  rx,  ry,  rz,  0.0); 
if  (counter  <  timegreen) 

{ 

objreplace(greenlighttag) ; 
color  (GREEN); 
objreplace(redlighttag) ; 
color  (DIMRED); 
lightcolor  =  GREENLIGHT; 

} 

else  if  ((counter  >  timegreen)  &£&£  (counter  <  =  timeyellow)) 

{ 

objreplace(greenlighttag) ; 

color(DIMGREEN); 

objreplace(yellowlighttag) ; 

coIor(YELLOW); 

lightcolor  =  YELLOWLIGHT; 

} 

else  if  ((counter  >  timeyellow)  &&  (counter  <=  timered)) 

{ 

objreplace(yellowlighttag) ; 
color(DIMYELLOW); 
objreplace(redlighttag) ; 
color(RED); 

lightcolor  =  REDLIGHT; 

} 

else  if  (counter  timered) 

{ 

counter  =  0; 

} 

closeobj(); 

callobj(road); 

/*  EDIT  HOI'SES  7 

editobj(house); 


'it  ll. 
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objreplace(houselooktag); 
Iookat(cx,cy,cz.rx.ry.rz,0.0) ; 
objreplace(housetranstag) ; 
translate(-80.0,  0.0,  -50.0); 
objreplace(housescaletag); 
scale(0.40,  0.40,  1.0); 
closeobj(); 
callobj  (house); 

editobj  (housel); 
objreplace(housellooktag) ; 
lookat(cx,cy,cz,rx,ry  ,rz,0.0) ; 
objreplace(houseltranstag) ; 
translate (-30.0,  0.0,  -10.0); 
objreplace(houselscaletag) ; 
scale(0.50.  0.50.  1.0); 
closeobj(); 
callobj  (housel); 


editobj  (housel); 
objreplace(housellooktag); 

Iookat(cx,cy,cz,rx,ry,rz,0.0); 
objreplace(houseltranstag) ; 

translate(-30.0,  0.0.  -15.0); 
objreplace(houselscaletag) ; 
scale(0.50,  0.50,  1.0); 
closeobjQ: 
callobj  (housel); 

/*  edit  steerino  wheel  • 

editobj(steerwheel); 
objreplace(steerwheeltag ) ; 

rotate((int)  -(steer  wheel  angle  *  10  *  RAD  TO  DEO 

closeobj(); 

callobj  (steerwheel ) ; 

/■  EDIT  ODOMETER  ‘ 

editobj)  odometer 1 : 
objrep!ace(odotagl  | 
charstr(thousandr ) 
objrep!aoe(odotag2 1 ; 
charstrfhundredr ) . 
objreplace(odotag3 ! . 
charstr(tenc). 
objreplaoe(odotag-4  I 


( 
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charstr(unitc); 
closeobj(); 
callobj(  odometer); 


/*  Display  the  clock  */ 

color(  WHITE); 
cmov2i(100,  750); 
charstr(clockc); 
color!  BLACK); 
color(CYAN); 
cmov2i(400.  750); 
switch(condition) 

{ 

case  AUTOPILOT;  charstr(" AutoPilot"); 
break; 

case  CruiseDrSteer:  charstr( "Cruise  Control.  Driver's  Steering"); 
break; 

case  CruiseNavSteer:  charstr("Cruise  Control.  Navigator’s  Steering"); 
break. 

case  ASteerDrSp:  charsti (" AutoSteer,  Driver’s  Speed"); 
break; 

case  ASteerNSp:  charstrf "AutoSteer.  Navigator’s  Speed"); 
break; 

case  DrManual:  charstr! "Driver  Manual  Control"); 

break; 

case  NavManual  charstr! "Navigator  Manual  Control"); 
break; 

case  DrMeerNavSp  charstr!  "Driver  Steers,  Nav's  Speed"); 
break 

case  NavsteerDr^p  charstrl"Nav  Steers.  Driver's  Speed"): 
breaK . 


•t  PL  A*  K 


’  EDIT  WAR.MN(,  INDICATOR  */ 
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editobj(waming) ; 
objreplace(braketag) ; 
color(WARN); 

} 

if  (state  vector[3j  >  0) 

{  " 

objreplace(belttag) ; 
color(WARN); 
if  (alarm) 

{ 

objreplace(dangertag) ; 
color(CYAN); 

} 

else 

{ 

objreplace(dangertag): 

color(WARN); 


closeobj(); 

} 

else 


/*  BRAKE  SIGNAL  FOR  CAR  STOP  */ 


editobj  (warning); 
objreplace(braketag) ; 
color(RED); 
objreplace(temptag) ; 
color(RED): 
closeobjQ; 

} 

if  ((count  <  1000)  &&  (state  vector[3]  >  0.0)) 

'  { 

editobj  (warning); 
objreplace(temptag) ; 
color  (WARN); 
closeobj(); 

} 

if  ((count  >  5000)  &&  (state_vector[3]  *  MPS  TO  KMPH  >  65)) 

{  "  ■  "  " 

editobj  (warning) ; 
objreplace(temptag) ; 
color(RED); 


closeobjQ; 

} 

callobj(warning); 

/*  EDIT  HEADING  INDICATOR  */ 

/*  Compute  heading  using  vehicle  state  vector  '/ 
if  (state  vector(4j  <  0.0)  headingrad  =  2*PI-fstate_vector[4j; 

else  headingrad  =  state_vector[4); 
no  of  round  =  (headingrad*  180.0/PI)/360.0; 
headingdeg  =  headingrad*  180.0/PI  -  (float)  no_of_round*36Q; 

editobj (heading  meter) ; 
objreplace(transl  1 ) ; 

translate(heading_xpos-20.0-4.5*headingdeg,  4.0,  0.0); 
closeobjQ; 

callobj (heading  meter); 

/*  EDIT  SPEEDOMETER  INDICATOR  ‘/ 

/*  2.5  factor  is  for  converting  to  the  dashboard  display  */ 

speedbar  =  181.0  -  state  vector(3]  *  MPS  TO  KMPH  1  2.5: 

editobj  (speedometer) : 
objreplace(transl4) ; 
translate(0.0,  speedbar,  0.0); 
closeobj(); 

callobj  (speedometer); 

/*  EDIT  BRAKE  AND  CMDSPEED  GUAGES  */ 

editobj(gauges); 

objreplace(manbraketag); 

rectfi(BRAKEX,  BRAKEY,  BRAKEX  +  50,  BRAKEY  -  accel  brake); 

objreplace(manspeedtag); 

rectfi(CMDX.  CMDY,  CMDX  +  50. 

CMDY  +  (int)(2  *  speed  *  MPS  TO  KMPH)); 
closeobjQ; 
callobj  (gauges); 

/*  EDIT  FUEL  GUAGE  */ 
if  (state  vector[3]  *  MPS  TO  KMPH  ■  0.0) 


fuelquant  =  fuelquant  -  consumption; 

} 

if  (fuelquant  <=  0.0) 

{ 

fueldown  =  -1000.0; 

} 

fuelbar  =  fuelquant/MAXFUEL*320.0  -I-  14.0; 


editobj(fuel); 
objreplace  ( fuel  1 ) ; 
rectf(281.0,  14.0,  324.0,  fuelbar); 
closeobjQ; 
callobj(fuel); 

/*  EDIT  CRASH  INFO  DISPLAY  FOR  OFF-ROAD  *J 

pushmatrix(); 
pushattributes() ; 
translate(0.0,crashdown,0.0); 

/*  Set  all  warning  lights  when  crash  */ 
if  (crashdown  ==  -1000) 

{ 

editobj  (warning); 

objreplace(braketag); 

color  (RED); 

objreplace(dangertag); 

color  (RED); 

closeobj(); 

callobj(warning); 

} 

color(RED); 

rectf(0.0, 1385.0, 1023.0,1767.0); 

color(BLACK); 
cmov2i(370,1576); 
charstr("  CRASH"); 

cmov2i(370,1560); 
charstr("OFF  THE  ROAD"); 

cmov2i(370,1544); 
charstr("PUSH  ’E’  TO  EXIT"); 

popattributesQ; 

popmatrix(); 

swapbuffers(); 

}  /*  while  loop  */ 


clear(); 

swapbuffersQ; 

finishQ; 

gexit(); 

}  /*  main  */ 

***************************************** 

filename:  CIRCUIT.C 
author:  Tan  Chiam  Huat 
modified  by:  Michael  J.  Dolezal 
date:  May  20,  1987 

******************************************* ***  j 

#include  "const. h" 

#include  "vars.ext.h" 


j ******* 


**********«***********t********************«****x«*t«* 


BUILD  THE  RALLY  CIRCUIT 

*********************************************** *************,/ 

maketheroad  ( road ) 

Object  *road; 

{  ' 

Dimension  temp,  i; 

Dimension  high  =  3.2: 

Colorindex  signbg  =  YELLOW; 

Colorindex  upsign  =  RED; 

Colorindex  rightsign  =  BLUE; 

*road  =  genobjQ; 
makeobj(*road); 
pushmatrix(): 
pushviewportQ: 

viewport(0,  XMAXSCREEN,  385,  YMAXSCREEN); 
setdepth(0,1023); 

perspective (Fov,  1023.0/385.0,  0.0,  1023.0); 
roadlooktag  =  gentag(); 
maketag(roadlooktag) ; 
lookat(0.0,  0.0,  0.0,  0.0,  0.0,  0.0,  0); 


FIRST  STRETCH  OF  ROAD 


surf(0.0,  0.0,  0.0,  ROADWIDTH,  ROADLEN,  BLACK); 
surf(-4.2,  0.0,  0.0,  0.2,  ROADLEN,  YELLOW); 

r 

Build  the  sign  "START" 

7 


temp  =  -3.6: 
color(  WHITE); 
pushmatrixQ; 

translate!  temp  -r  1.0.  0.0.  0.01; 
rotate(-900.'X); 
letter(’T\  BLACK); 
popmatrix(); 

color(  WHITE); 
pushmatrix(); 

translate(temp  -  0.25,  0.0.  0.0): 

rotate(-900,’X'); 

letter(  R'.  BLACK); 

popmatrixf); 

colon  WHITE): 

pushmatrix(); 

translate(temp  -  1.5.  0.0,  0.0) ; 
rotate(-900,  X  ): 
letter('A\  BLACK); 

popmarrix  ); 

color!  WHITE): 
pushinatrix(); 

translate(temp  -  2.75.  0.0.  0.0); 
rotate(-900.'X). 
letter(’T'.  BLA(.'K); 
popmatrixf ): 


color  (WHITE); 
pushmatrix( ); 

translate  (temp  -  4.0.  0.0.  0.0); 
rotate(-900.'X); 
letter) ’S'.  BLACK); 
popmatrix(); 

r 

Build  the  sign  "TURN"  before  the  bend 
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color(  WHITE); 
pushmatnx( ); 

translate! -3.25.  0.0.  -^ROADLEN  -  5.0)1: 

rotate(-900 

letter! ’N’.  BLACK); 

poprnatrixi ): 

color!  WHITE); 
pushmatrixf); 

translate(-4.5.  0.0.  -(ROADLEN  -  5.0)); 

rotate(-900.'X); 

letter('R\  BLACK); 

popmatrix(); 

color!  WHITE); 
pushmatnxO. 

tran»iate(-5.75.  0.0.  -^ROADLEN  •  5  0); 
rotate! -900.  X  ; ; 
letter!  U\  BLACK). 
popmatrix( ) ; 

color!  WHITE 
P'Munatnx! 

t  ransiate;  -  *  0.  0  0.  -(ROADLEN  .5  Oi 
rot  ate  ( -900.  X  ); 
letter!  T  .  BLAt’K); 
popmatrix  ( ) . 


Add  the  first  crossroad 
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pushmatrix(); 

translate(0.0,  0.0,  -(ROADLEN/4.0)); 
rotate(900,  ’Y’); 

translate(0.0,  0.0,  2.0  *  ROADLEN); 

stripe(0.0,  0.0,  0.0,  ROADWIDTH/2.0,  8.0  *  ROADLEN,  BLACK); 
for  (temp  =  20.0;  temp  <  (4.0  *  ROADLEN);  temp  +=  40.0) 

{ 

pushmatrix(); 
translate(0.0,  0.0,  -temp); 
rotate(-900,’X’); 

polyarrow(0.7,  1.2,  0.0,  WHITE); 
popmatrixQ; 

} 

popmatrix(); 

r 

Add  the  second  crossroad 
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pushmatrix(); 

translate(0.0,  0.0,  -(3.0  *  ROADLEN/4.0)); 
rotate(900,  ’Y’); 

transiate(0.0,  0.0,  2.0  *  ROADLEN); 

stnpe(0.0,  0.0,  0.0,  ROADWIDTH/2.0,  8.0  *  ROADLEN,  BLACK); 
for  (temp  =  20.0;  temp  •  (4.0  *  ROADLEN);  temp  +=  40.0) 

{ 

pushmatrix(); 
tranalate(0.0,  0.0,  -temp); 
rotate(-900.'X'); 

polvarrow(0.7.  L  2.  0.0.  WHITE); 
popmatrix( ); 

I 

popmatrixf ) ; 

r 


Create  1st  speedlimit  si^n 


7 


pushmatrixQ; 
translate(6.0,  0.0,  -15.0); 
speedlimit(’2’.  5); 
popmatrix(); 

r 

Create  2nd  speedlimit  sign 

7 

pushmatrixQ; 

translate(6.0,  0.0,  -(ROADLEN/4.0)  -  15); 

speedlimit('3\  ’5'); 

popmatrix(); 

r 

Create  the  50  meter  distance  marker 

7 

pushmatrix(); 
translate (0.0,  0.0,  -42. 0, , 
rotate(-900,  ’Y'); 

stripe(0.0,  0.0,  0.0,  0.2,  4.0,  WHITE); 
popmatrix(); 

temp  =  -3  6; 

coIor(WHITE); 

pushmatnx(); 

translate(temp  -  2.75.  0.0,  -38  25); 
rotate(-900.  'X'); 
letterQO  .  BLACK); 
popmatnxl ) . 

color(  WHITE). 
pushmatrix( ) 

translate) temp  -  4  0.  0.0,  -38  251 
rotate(-900  X  I. 
letter) ’5  .  BLACK), 
popmatnxl ) 
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Create  the  40  meter  distance  marker 


pushmatrix(); 
translate (0.0.  0.0,  -52.0); 
rotate(-900.  V); 

stripe(0.0.  0.0.  0.0.  0.2.  4.0,  WHITE) 
popmatrixl ); 

temp  =  -3.6. 
color(  WHITE); 
pushmatrixf ). 

translate! temp  -  2.75.  0  0.  -48  25:. 
rotate(-900.  X  ); 
letter('0\  BLACK); 
popmatrixl ) . 

color(  WHITE); 
pushmatnx(). 

translate(temp  -  4.0,  0.0.  -48.25); 
rotate(-900.  ’X  ); 
letter(’4  ,  BLACK), 
popmatrixi ) ; 


•  reate  the  30  meter  distance  marner 

•  / 


piishmatrixf ) 

•  ransiaf •  1 1  ft  0  0  -02  i 1 1 

-i  date1  •' JOO  5 

>t  ripe  it  i  o  oo  no  03  40  W  Hill 

popmatrixl  1 . 

temp  -  3  6 

c.lori  WHITE  1 

p'lshmatrixi  ! 

•  ranslatef  temp  2  75  00  5s  23 
rotate!  OOO  \ 


letter) ’O'.  BLACK); 
popmatrixi )  ; 


color(  WHITE); 
pushmatnx) ); 

translate) temp  -  4.0.  0.0.  -58.25); 
rotate)-900  X); 
letter(’3’.  BLACK); 
popmatrixi ); 

/* 

Create  the  20  meter  distance  marker 


7 

pushmatrixj  ). 
translate|0.0.  0.0.  -72.0) 
rotate! -900.  'Y'i; 

stripe(0.0.  0.0.  0  0.  0.2.  4  0.  WHITE) 
popmatrixi ). 

temp  =  -3  6; 
color)  WHITE) 
pushmatnx) ). 

translate) temp  2  75.  0  0.  -68  25). 
rotate) -900  'X). 
letter('0\  BLACK 

[M'prnaf rix  ) 

colon  W  HITE 
pushmatnx |  I 

translate! temp  4  0  oo  6s  25' 
rotate!  9<10  \  i 

ef  terl  2  'll  \  K 
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pushmatnx!  I  . 
translate!  0  u  00.  -82  O' 
rotate! -9(X).  ‘Vi. 
stnpejO.O.  0  0.  0  0.  0.2.  4  0 
popmatrixi 

temp  =  3  6 

color)  WHITE 
pushiuatnx!  I. 

translate! temp  2  73.  0  0. 
rotate! -900  X 
letter!  ()  BL At  K  1 
popmatrixi  i 
color!  WHITE 
pushmatnx : 

tranaiatei  temp  4  0  no 
rotate) -900  X 
letter!  1  BLA<  K 
popmatrix 


<  reate  1  *»r  stopHinn 
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Create  the  60  meter  distance  marker 


•  / 

pushmatrix(); 
translate(0.0,  0.0.  -232.0), 
rotate(-900,  'Y'); 

stripe(0.0.  0.0,  0.0.  0.2.  4.0.  WHITE) 
popmatrix) ), 

pushmatrixl ) , 
translate! 5  2,  0.0.  -232  0), 
btllboardl'6  O'), 
popmatrix 


('reate  the  3(1  meter  distance  marker 


pushmatnxi : 

translate  0  (I  0  0  242') 

rotate!  900  Y  i 

st  ripe  1 0  o  oo  oil  o  2  4  0  WHITE 

popmatrix 
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First  road  bend 


7 

pushmatrixQ; 

translate(BENDRADIUS,  0.0,  -ROADLEN); 

rotate(-900,  ’X1); 

bend(); 

popmatrix(); 

r 

Build  1st  right  turn  signboard 

7 

pushmatrix(); 

translate(5.0,  0.0,  -(ROADLEN-5.0)); 
signb(1.9.  2.5.  3.0.  signbg); 
popmatrix(); 
pushmatrix(): 

translate(4.3,  4.0.  -(ROADLEN-5.0)); 
rotate(-900,’Z'): 

poly  arrow  (0.7.  1.2.  0.0.  rightsign); 
popmatrix(); 

************* 

SECOND  STRETCH  OF  ROAD 

. . . . 

pushmatrix() ; 

translate ( BE N D R AD II* S .  0.0.  -ROADLEN  -  BENDRADIUS); 
rotate(-900,  'Y'): 

surffO.O.  0.0.  0.0.  ROADWIDTH.  ROADLEN.  BLACK): 
popmatrixf ): 

r 


Build  a  series  of  road  strips 


color(  WHITE); 

for  (i  =  BENDRADIUS  +  8.0;  i  <  ROADLEN;  i  +=  20.0) 

{ 

pushmatrixQ; 

translate^,  0.0,  -ROADLEN  -  BENDRADIUS  -  (ROADWIDTH/4)); 

rotate(-900,  ’Z’); 

rotate(-900,  ’Y’); 

rectf(-0.5,  0.0,  0.5,  3.0); 

popmatrixQ; 

} 

color(BLACK); 

r 

Create  3rd  uparrow  signboard 
*/ 

pushmatrix(); 

translate(BENDRADIUS  +  50.0,  0.0,  -ROADLEN  -  BENDRADIUS  +  6); 

rotate(-900,’Y’); 

signb(l.9,  2.5,  3.0,  signbg); 

popmatrixQ; 

pushmatrixQ; 

translate(BENDRADIUS  +  50.0,  high,  -ROADLEN  -  BENDRADIUS  +  6); 
rotate(-900,-,Y’); 

polyarrow(0.7,  1.2,  0.0,  upsign); 
popmatrixQ; 

r 

Second  road  bend 

V 

pushmatrixQ; 

temp  =  BENDRADIUS  +  ROADLEN; 

translate(temp,  0.0,  -ROADLEN); 

rotate(-900,  ’X’); 

rotate (-900,  ’Z’); 

bendQ; 

popmatrixQ; 
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Build  2nd  right  turn  signboard 

7 

pushmatrix(); 

translate  (temp  -  ROADWIDTH,  0.0, 

-ROADLEN  -  BENDRADIUS  -  (3  *  ROADWIDTH/4.0)  -  2); 
rotate(-900,’Y’); 
signb(l.9,  2.5,  3.0,  signbg); 
popmatrix(); 
pushmatrix(); 

translate  (temp  -  ROADWIDTH,  4.0, 

-ROADLEN  -  BENDRADIUS  -  2.7  -  (3  *  ROADWIDTH/4.0)); 
rotate(-900,’Y’); 
rotate(-900,’Z’); 

polyarrow(0.7,  1.2,  0.0.  rightsign); 
popmatrix(); 


y****************. ************:«** 


THIRD  STRETCH  OF  ROAD 
******************************** 


pushmatrix(); 

temp  =  2  *  BENDRADIUS  +  ROADLEN; 
translate(temp  +  (ROADWIDTH/2).  0.0,  0.0); 
surf(0.0,  0.0,  0.0,  ROADWIDTH,  ROADLEN,  BLACK); 
popmatrix(); 

I* 


Create  a  series  of  arrows 


7 

i 

for  (i  =  ROADLEN;  i 

>  5.0;  i  -=  20.0) 

y 

y 

{ 

4 

pushmatrixQ; 

a 

translate  (temp  4- 

(ROAD WIDTH/4.0),  0.0 

to 

r-, 

rotate  (-900, ’X’); 
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rotate(-1800,  ’Z’): 

poly  arrow  (0.7,  1.2,  0.0,  WHITE); 

popmatrix(); 

} 


r 

Create  5th  speedlimit  sign 

7 

pushmatrixQ; 

translate(ROADLEN  +  (2  *  BENDRADIUS)  -  6.0, 

0.0,  -ROADLEN/4.0  +  10.0); 
rotate(-1800,  ’Y’); 
speedlimit(’5Y5); 

popmatrixQ; 

/+  Create  3rd  stopsign  */ 
pushmatrix(); 

translate(ROADLEN  +  (2  *  BENDRADIUS)  -  6.0,  0.0,  -ROADLEN/4.0  -  5.0); 
rotate(-1800,  ’Y’); 
stopsign(1.9,  3.0); 
popmatrix(); 

r 

Create  4nd  uparrow  signboard 

7 

pushmatrixQ; 

translate  (temp  +  ROADWIDTH,  0.0,  -ROADLEN  +  10.0); 

rotate(-1800.'Y'); 

signb(1.9,  2.5.  3.0.  signbg): 

popmatrix(); 

pushmatrix(); 

translate(temp  -f  ROADWIDTH,  high,  -ROADLEN  +  10.0); 

rotate(-1800,’Y’); 

polyarrow(0.7,  1.2,  0.0,  upsign); 

popmatrix(); 
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Create  5th  speedlimit  sign 


pushmatrixQ; 

translate(ROADLEN  +  (2  *  BENDRADIUS)  -  6.0, 
0.0,  -  3  *  ROADLEN/4.0  +  10.0); 
rotate(-1800,  ’Y’); 
speedlirait(’4  Y5’); 
popmatrix(); 


Create  2nd  stopsign 


pushmatrix(); 

translate(ROADLEN  +  (2  *  BENDRADIUS 
0.0,  -  3  *  ROADLEN/4.0  -  5.0): 
rotate(-1800,  rY’); 
stopsign (1.9,  3.0); 
popmatrix(); 


)  -  6.0, 


Third  road  bend 


pushmatrix(); 

temp  =  BENDRADIUS  +  ROADLEN; 

translate(temp,  0.0,  0.0); 

rotate(-900,  X  ); 

rotate(-1800,  ’Z'); 

bend(); 

popmatrix(); 

y******************************* 

FOURTH  STRETCH  OF  ROAD 


pushmatnx) ). 

temp  =  BENDRADirs. 

translate! temp.  0.0.  temp  +  (ROADWIDTH  2)1 
rotate(-900.  'Y’|; 

surf(0.0.  0.0.  00,  ROAD  WIDTH.  ROADLEN.  BLA<  Ki. 
popmatrix(); 

r 

Create  a  series  of  arrows 

7 

for  (i  *  temp  10  0  i  temp  *■  ROADLEN  i  -  “  20.01 

{ 

pushmatnx! ) 

translate^.  0  0.  temp  -  '  RO ADW  IDTH  4  0) , . 

rotate(-9(Xl,‘X'). 

rotate(900.Z) , 

poiyarrow(0.7.  1.2.  0.0.  WHITE) 
popmatrix(). 

} 

r 

Create  5nd  uparrow  signboard 

V 

pushmatrix() . 

translate( ROADLEN.  0.0.  BENDRADIfS  s-  ROADWIDTH); 

rotate(-2700.'Y) ; 

signb(1.9.  2.5.  3.0.  signbg): 

popmatrixf ). 

pushmatrix(); 

transIate(ROADLEN,  high.  BENDR  ADIl>  -t  ROADWIDTH) 

rotate(-2700.Y); 

polyarrow  v0. 7,  1,2,  0.0,  upsign); 

popmatrix(); 


Fourth  rohii  in-mi 


pushmatnxi  i 

translate! BENDR ADM  > .  O')  0U|. 

rotate! -900  X  ) 

rotate(900,  Z  ) 

i>emi( ) . 

popmatrixl  i 

popvieta  port  t  i 
popmatrixf 
c  loaeobj!  i 
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Dimension  legwxlt h.  tempi  temp2.  t «-iii j>3 
legwidth  -  0  2  "  size  of  supporting  ieg 

tempi  =  length,  2, 
temp  2  =  length/ 4. 
temp3  =  legvvi<lth  2: 

verticeiO^  Oj  =  0.0; 
vert  ice  [0j.  l]  =  height  ; 
vertice[0):2j  =  0.0; 

vertice[l]  [0]  =  -tempi; 
vertice[l][l]  =  height: 
vertice[l][2]  =  0.0; 


•mw\  !<  r  *  O 


hfiftht 


M  *  ♦  !IiJ»  1 

ertire  3  1  -=  width  +  height. 


>•  ert  ire  4  0  —  tempi ; 

\«'rtire4  1  -  height: 

vert  ire  4  2  =  0  0: 

ruiorl  beoiori . 
puifl  o  vert  ,re ) : 


/*  Generate  the  supporting  leg  */ 


vertirel  0  0 
verticel  |0  1 II 
vertirel  0;  2\ 

vertirel  [l;,0j 
vertirel  [l]  [l] 
verticel  [l  j  [2j 

verticel[2j[0] 
verticel[2][l] 
verticel  [2]  [2] 

verticel  [3j[0] 
verticel  [3]  [lj 
verticel  [3]  [2] 


-temp3; 

0.0; 

0.0; 

-temp3; 

height; 

0.0; 

temp3; 

height; 

0.0; 


verticel  [4]  [0]  =  temp3; 
verticel[4][l]  =  0.0; 
verticel  [4]  [2]  —  0.0; 

color(BLACK): 

polf(o.verticel); 

}  /*  signboard  *  j 


+ ***********  +  t  *  «  *  ♦  •  «  «  «  • 


MO -HI  84  138 


n  SIMULATION  STUOV  OF  fl  SPEED  CONTROL  SVSTEH  FOR 
AUTONOMOUS  ON-ROMD  OPERA. .  <U>  NAVAL  POSTCK’ADUATE  SCHOOL 
HONTEREV  CA  M  J  DOLEZAL  JUN  87  NPS32-87-028 


HONTEREV  CA  H 

UNCLASSIFIED  NIPR-ATEC-88-8S 


************************************************************* 


stopsign  (width,  height) 

Dimension  width,  height; 

{ 

Coord  vertice  [10]  [3]; 

Coord  verticel  [5]  [3]; 

Dimension  legwidth,  tempi,  temp2,  temp3,  temp4; 

legwidth  =  0.2;  /*  size  of  the  supporting  leg  */ 

tempi  =  5  *  width/24; 

temp2  =  width/2; 

temp3  =  legwidth/ 2; 

temp4  =  7  *  width/24; 

/*  Make  the  sign  *  j 
vertice  [0][0]  =  0.0; 

vertice  [0][l]  =  height; 

vertice  [0][2]  =  0.0; 

vertice  [l][0]  =  tempi; 

vertice  [l][l]  =  height; 

vertice  [l][2]  =  0.0; 

vertice  [2]  [0]  =  temp2; 

vertice  [2]  [l]  =  temp4  +  height; 

vertice  [2]  [2]  =  0.0; 

vertice  [3]  [0]  =  temp2; 

vertice  [3] [l]  =  temp4  +  (2  *  tempi)  +  height; 

vertice  [3]  [2]  =  0.0; 

vertice  [4] [0]  =  tempi; 

vertice  [4] [lj  =  height  +  width; 

vertice  [4]  [2]  =  0.0; 

vertice  [5] [0]  =  -  tempi; 

vertice  [5][lj  =  height  +  width; 

vertice  [5]  [2]  =  0.0; 

vertice  [6]  [0]  =  -  temp2; 

vertice  [6] [lj  =  temp4  +  (2  *  tempi)  +  height; 
vertice  [6]  [2]  =  0.0; 


vertice  [7]  [0]  =  -  temp2; 


vertice  [7]  [l]  =  temp4  +  height; 

vertice  [7]  [2]  =  0.0; 

vertice  [8][0]  =  -  tempi; 

vertice  [8][l]  =  height; 

vertice  [8]  [2]  =  0.0; 

vertice  [Q]  [0]  =  0.0; 
vertice  [9][l]  =  height; 
vertice  [9]  [2]  =  0.0; 

color(RED); 
polf  (10,  vertice); 

/*  Put  the  face  on  the  stopsign  */ 

color(  WHITE); 
linewidth(2); 
poly  (10,  vertice); 

/*  Put  the  letters  STOP  on  the  sign 

color( WHITE);  ' 
pushmatrixQ; 
translate(-0.6,  4.0,  0.0); 
scale(0.5,  0.5,  1.0); 
translate (-5.0,  -3.8,  0.0); 
letter(’S’,  RED); 
popmatrix(); 

color(  WHITE); 
pushmatrixQ; 
translate(-0.2,  4.0,  0.0); 
scale(0.5,  0.5,  1.0); 
translate(-5.0,  -3.8,  0.0); 
letter (T\  RED); 
popmatrix(); 

color(  WHITE); 
pushmatrix(); 
translate(0.2,  4.0,  0.0); 
scale(0.5,  0.5,  1.0); 
translate(-5.0,  -3.8,  0.0); 


letter(’0\  RED); 
popmatrix(); 

color(  WHITE); 
pushmatrix(); 
translate (0.6,  4.0,  0.0); 
scale(0.5,  0.5,  1.0); 
translate(-5.0,  -3.8,  0.0); 
letter(’P’,  RED); 
popmatrix(); 

/*  Build  the  supporting  leg  */ 


color  (GRAY); 

rectf(-temp3,  0.0,  temp3,  height); 

}  /*  Stopsign  */ 

/ft************************ **************************************** 

BUILD  SIGNAL 

***********************************************  M  ***************** 

signallight  (height) 

Dimension  height; 

{ 

Dimension  legwidth  =  0.5; 

Dimension  separation  =  20; 

Dimension  temp,  tempi,  temp2; 
temp  =  0.70  *  height; 
tempi  =  0.30  *  height; 
temp2  =  legwidth/2; 


/*  Build  the  post  */ 


color  (GRAY); 

rectf(-temp2,  0.0,  temp2,  temp  -  (0.05  *  height)); 

rectf(-temp2  -  separation,  0.0,  temp2  -  separation,  temp  -  (0.05  *  height)); 

/*  Build  the  background  and  lights  */ 


color(BLACK); 


rectf(- (temp  1/3.0),  temp  -  (0.05  *  height),  templ/3.0,  (1.05  *  height)); 
rectf(-(templ/3.0)  -  separation,  temp  -  (0.05  *  height), 
templ/3.0  -  separation,  (1.05  *  height)); 
greenlighttag  =  gentag(); 
maketag(greenlighttag) ; 
color(GREEN); 

circf(0.0,  ((templ/6.0)  +  temp),  templ/7.0); 
circf(-separation,  ((templ/6.0)  +  temp),  templ/7.0); 

yellowlighttag  =  gentag(); 
maketag(yellowlighttag) ; 
color(DIM  YELLOW); 

circf(0.0,  ((templ/2.0)  +  temp),  templ/7.0); 
circf(-  separation,  ((templ/2.0)  4-  temp),  templ/7.0); 

redlighttag  =  gentagQ; 
maketag(redlighttag) ; 
color  (DIMRED); 

circf(0.0,  height  -  (templ/6.0),  templ/7.0); 

circf(-  separation,  height  -  (templ/6.0),  templ/7.0); 

}  /*  Green  Light  */ 

***************************************************  ******* 

BUILD  ARROW 

*************************************************************  j 

polyarrow(bodywidth,  headwidth,  high,  arrowcolor) 

Colorindex  arrowcolor; 

Dimension  bodywidth,  headwidth,  high; 

{ 

Coord  vertice[5][3],  vert  ice  1  [3]  1 3]; 

Dimension  bodyheight  =  0.8; 

Dimension  headheight  =  1.5; 

Dimension  tempi  =  bodywidth/2; 

Dimension  temp2  =  headwidth/2; 

vertice[0]  [0]  =  0.0; 
vertice[0](lj  =  0.0  4-  high; 
vertice[0j[2]  =  0.0; 


verticejl]  [0]  =  -tempi; 
verticefljjl]  =  0.0  +  high; 
vertice[l][2]  =  0.0; 
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vertice(2]  [0]  =  -tempi; 
vertice[2][l]  =  bodyheight  -I-  high; 
vertice[2][2]  =  0.0; 


vertice[3][0]  =  tempi; 
vertice[3][l]  =  bodyheight  +  high; 
vertice[3][2]  =  0.0; 


vertice[4][0]  =  tempi; 
vertice[4][l]  =  0.0  +  high; 
vertice[4][2]  =  0.0; 


color  (arrowcolor) ; 
polf(5,vertice); 


verticel[0][0]  =  -temp2; 
verticel[0][l]  =  bodyheight  +  high; 
verticel[0][2]  =  0.0; 


verticel[l](0]  s  0.0; 
verticeljljjl]  =  headheight  +  high; 
verticel[lj[2]  =  0.0; 


vert  ice  1  [2]  [0]  =  temp2; 
verticel[2][l]  =  bodyheight  +  high: 
verticel[2][2j  =  0.0; 


color  ( arrowcolor) ; 
polf(3,verticel); 

}  /*  poly  arrow  */ 


/♦****************«******«**»********  ***.*»**»**».»»»*««*«*♦>* 


BUILD 


HOUSE 


makehouse  (house) 
Object  *house; 


yy-yy  yvv- 


{ 

float  sidewall(5]  [2j ,  rooff4j[2j,  chmwalll(4}[2j; 
float  chmwall2[4j[2j,  sideroof{4][2j; 

*  house=genobj  ( ) ; 
makeobj  (*  house) ; 

pushmatrix(); 
pushviewport(); 
viewport(0,  1023,  385,  767); 
setdepth(0,1023); 

perspective(Fov,  1023.0/385.0,  0.0.  1023.0): 
houselooktag  =  gentag(); 
maketag(houselooktag) ; 
lookat(0.0,  0.0,  0.0,  0.0,  0.0,  0.0,  0); 

pushmatrixQ; 
housetranstag  =  gentag(); 
maketag(housetranstag) ; 
translate (0.0,  0.0,  0.0); 
housescaletag  =  gentag(); 
maketag(housescaletag) ; 
scale(1.0,  1.0,  1.0); 

/*  Draw  front  wall  */ 

color(WALL); 
rectf(-1.0, 0.0, 16.0, 10.0); 

/*  Draw  side  wall  */ 

sidewall(O)  [0] =(-4.0); 
sidewall[0][lj=(2.0); 
sidewall[l][0)=(0.0); 
sidewall[l][lj=(0.0); 
sidewall[2}  [0] =(0.0) : 

8idewall[2j[l]=(10.0); 
sidewall(3]  [0]= (-3 .0) ; 

8idewall[3)[l]=(13.0); 

sidewall[4)[0]=(-4.0); 

sidewall[4][lj=(11.5); 

color(SIDEWALL); 
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polf2(  5, sidewall); 


/*  Draw  roof  and  sideroof  */ 


roof[0][0]=(-1.0); 
roof(0][l]=(10.0); 
roof|l]  [0] = ( 1 7.0) ; 
roofflj[l]*(10.0); 
roof[2][0]=(14.0); 
roof[2](lj=(13.5); 
roof|3]  [0]= (-3.0) ; 
roof[3][l]=(13.5); 

color  (ROOF); 
polf2(4,roof); 

sideroof[0]  [0]  =  (-4.3) ; 
sideroof(0]  [  1] = ( 1 1 .5) ; 
sideroof(  l]  [0]  =  (-4 .0) : 
sideroof(lj[l]=(11.5); 
sideroof|2]  [0] =(-2.8) ; 
sideroof|2]  [  1  ]  =  ( 1 3 . 1 ) ; 
sideroofl3]  [0]  ==  (-3.0) ; 
sideroof|3][l]=(13.5); 

color(SIDEROOF); 
polf2  (4 ,8ideroof) ; 

/*  Draw  window  *  / 

color(  WINDOW); 
rectf(2.0,4.0,5.0,7.0); 
rectf(9.0, 4.0, 12.0.7.0); 

/*  Draw  window  frames  */ 

color(FRAME); 

linewidth(4); 

move(2.0,4.0,0.0); 

draw(5.0,4-0,0.0); 

draw(5.0,7.0,0.0); 

draw(2.0,7.0,0.0); 

draw(2.0,4.0,0.0); 


move(3.5,4.0,0.0); 
draw{3.5,7.0,0.0); 
move(2.0,5.5,0.0) ; 
draw(5.0,5.5,0.0); 

move{9.0,4.0,0.0) ; 

draw(12.0,4.0,0.0); 

draw  ( 12.0,7 .0,0.0) ; 

draw  (9 .0,7.0, 0.0); 

draw(9.0,4.0,0.0); 

move(10.5,4.0,0.0); 

draw(10.5,7.0,0.0); 

move(9.0,5.5,0.0); 

draw(12.0,5.5,0.0); 

/*  Draw  chimney  front  wall  */ 

color  (SIDEWALL); 
rectf(l. 0,12.0, 3.0, 14.2); 

/*  Draw  the  hole  on  the  chimney  */ 

color(BLACK); 
rectf(1.5, 13.3, 2.5, 13.8); 

/*  Draw  top  and  side  walls  of  the  chimney  */ 

chmwalll  [0]  [0]  =0.5; 
chmwalll[0][l]=12.5; 
chmwall  1  j  lj  [0]  =  1 .0; 
chmwalll  [l]  [l]  =  12.0; 
chmwalll  [2]  [0] = 1 .0; 
chmwall  1  [2]  [l] = 14 .2; 
chmwall  1  [3]  [0] =0.5 ; 
chmwalll  [3]  [lj= 14. 7; 

color  ( CHMW  ALLl) ; 
polf2  ( 4  .chmwall  1 ) ; 

chmwall2[0j(0)=2.5; 
chmwall2(0](l]  =  14.7; 
chmwall2[l][0]=3.0; 
chmwall2[l)[l)  =  14.2; 
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chmwa.112  [2]  [0]=1.0; 
chmwall2[2][l]=14.2; 
chmwall2[3][0|— 0.5; 
chmwall2[3][l]=14.7; 

color  (OHM  WALL2); 
polf2(4,chmwall2) ; 
popmatrix(); 

popviewportQ; 

popmatrix(); 

closeobjQ; 

}  /*  makehouse  */ 

makehousel  (house  1 ) 

Object  *housel; 

{ 

float  sidewall[5][2],  roof|4][2],  chmwalll[4][2]; 
float  chmwall2[4][2],  sideroof|4][2]; 

*  house  l=genobj() ; 
makeobj(*housel); 

pushmatrix(); 

pushviewport(); 

viewport (0  -  260,  1023  -  260,  385,  767); 
setdepth(0,1023) ; 

per8pective(Fov,  1023.0/385.0,  0.0,  1023.0); 
housellooktag  =  gentag(); 
maketag(housellooktag) ; 
lookat(0.0,  0.0,  0.0,  0.0,  0.0,  0.0,  0); 

pushmatrix(); 

house  ltranstag  =  gentagQ; 
maketag(houseltranstag) ; 
translate(0.0,  0.0,  0.0); 
houselscaletag  =  gentag(); 
maketag(houselscaletag) ; 
scale  (1.0,  1.0,  1.0);  * 

/*  Draw  front  wall  */ 

color(WALLl); 
rectf(-1.0, 0.0, 16.0, 10.0); 


/*  Draw  side  wall  */ 


sidewall(Oj  (0]=(-4.0) ; 
sidewall  (0][l]=(2.0); 
sidewall  [  1]  (0] = (0 .0) ; 
sidewalljl]  [l] =(0.0) ; 
sidewall  (2  j  (0] =(0.0) ; 
sidewall  [2]  ( l] = ( 10.0) ; 
sidewall  [3]  [0] = (-3 .0) ; 
sidewall[3][l]=(13.0); 
sidewall  [4]  [0] =(-4.0); 
sidewall[4][l]=(11.5); 
color(SIDEWALLl); 
polf2(5, sidewall); 

/*  Draw  roof  and  sideroof  */ 

roof|0][0]=(-1.0); 
roofJO]  [l  j  =  ( 10.0)  ; 
roof[lj[0]  =  (17.0); 
roof(lj[l]=(10.0); 
roof[2][0]=(l4.0); 
roof{2]  [l] = (13.5) ; 
roof[3]  [0] = (-3.0) ; 
roof[3][lj=(l3.5); 

color(ROOFl); 

polf2(4,roof); 

sideroof[0]  [0] =(-4.3); 
sideroof(0]jl]=(11.5); 
sideroof)  1  j  [0] = (-4 .0) ; 
sideroof[l][l]=(11.5); 
sideroof|2]  [0] = (-2.8) ; 
sideroof[2][lj=(13.1); 
sideroof(3]  [0] = (-3.0) ; 
sideroof[3][lj==(13.5); 

color  (SIDEROOF); 
polf2  (4, sideroof); 

/*  Draw  window  */ 


color  (WINDOW); 
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rectf(2.0,4.0,5.0,7.0); 
rectf(9.0, 4.0, 12.0, 7.0); 


/*  Draw  window  frames  */ 


color(FRAME); 

linewidth(4); 

move(2.0,4.0,0.0); 

draw(5.0,4.0,0.0) ; 

draw(5.0,7.0,0.0) ; 

draw(2.0,7.0,0.0); 

draw(2.0,4.0,0.0); 

move(3.5,4.0,0.0); 

draw(3.5,7.0,0.0); 

move(2.0,5.5,0.0) ; 

draw(5.0,5.5,0.0) ; 

move(9.0,4.0,0.0); 

draw(  12.0,4.0,0.0); 

draw(12.0,7.0,0.0); 

draw(9.0,7.0,0.0); 

draw(9.0,4.0,0.0); 

move(10.5,4.0,0.0); 

draw(  10.5,7.0,0.0); 

move(9.0,5.5,0.0); 

draw(12.0,5.5,0.0); 

/*  Draw  chimney  front  wall  */ 

color(SIDEWALLl); 
rectf(1.0, 12.0, 3.0, 14.2); 

/*  Draw  the  hole  on  the  chimney  */ 

color(BLACK); 
rectf(  1.5,13.3.2.5.13.8); 

/*  Draw  top  and  side  walls  of  the  chimney  */ 

chmwalll[0j  [0]  =0.5; 
chmwalll  [0]  [lj  =  12.5; 
chmwall  1  ( 1  ]  [0]  =  1 .0; 
chmwalll  [l]  [l]  =  12.0; 
chmwall  1  [2]  [0]  =  1 .0; 
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chmwalll[2][l]=14.2; 
chmwalll[3][0]=0.5; 
chmwalll  [3]  [l]  =  14.7; 

coIor(CHMWALLl); 
polf2  (4  ,chmwall  1 ) ; 

chmwall2[0j[0j=2.5; 
chmwall2[0][l]=14.7; 
chmwall2  [  l]  jo] = 3 .0 ; 
chmwall2[l][l]=14.2; 
chmwall2  [2]  [0] = 1 .0 ; 
chmwall2[2][lj=14.2; 
chmwall2[3]  [0]=0.5; 
chmwall2[3][l]=14.7; 

color  (CHMWALL2); 
polf2  (4  .chmwall2 ) ; 
popmatrix(); 

popviewport(); 

popmatrix(); 

closeobj(); 

}  /*  makehousel  */ 

j******************************** ***************  **************** 

SPEEDLIMIT 

******************************************************** ******* i 

speedlimit(numberl,  number2) 
char  numberl,  number2; 

{ 

float  vertice  [5]  [3]; 

Dimension  legwidth  =  0.2; 

Dimension  height  =  3.3; 

Dimension  width  =  1.625; 

Dimension  temp  =  legwidth/2.0; 

Dimension  tempi  =  width/2.0; 

/*  make  the  sign  face  */ 


202 


color  (WHITE); 

rectf(-templ,  height,  tempi,  height  +  (1.25  *  width)); 


vertice  [0]  [0] 
vertice  [0][lj 
vertice  [0][2] 
vertice  [l]  [0] 
vertice  [l][l] 
vertice  [l]  [2] 

vertice  [2][0] 
vertice  [2][l] 
vertice  [2]  [2] 

vertice  [3]  [0] 
vertice  [3] [l] 
vertice  [3]  [2] 

vertice  [4][0j 
vertice  [4]  [l] 
vertice  [4]  [2] 


=  -  tempi  ; 

=  height; 

=  0.0; 

=  -  tempi  ; 

=  height  +  (1.25  *  width); 
=  0.0; 

=  tempi  ; 

=  height  +  (1.25  *  width); 
=  0.0; 

=  tempi  ; 

=  height; 

=  0.0; 

=  -  tempi  ; 

=  height; 

=  0.0; 


J*  put  the  black  edge  on  the  sign  */ 


color  (BLACK); 
linewidth(2); 
poly (5,  vertice); 

/*  Add  the  speed  */ 


pushmatrix(); 
translate(-0.4,  4.0,  0.0); 
scale(0.8,0.8,1.0); 
translate(-5.0,  -3.8,  0.0); 
letter (numberl,  WHITE); 
popmatrixQ; 

color  (BLACK); 
pushmatrixQ; 
translate(0.35,  4.0,  0.0); 
scale(0.8,0.8,1.0); 
translate(-5.0,  -3.8,  0.0); 
letter(number2,  WHITE); 
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popmatrixQ ; 


vertice  [4]  [2]  =  0.0; 


/*  put  the  black  edge  on  the  sign 


color(BLACK); 
linewidth(2); 
poly (5,  vertice); 
linewidth(l); 

/*  Add  the  distance  */ 

color(RED); 
pushmatrix(); 
translate(-0.4,  0.8,  0.0); 
scale(0.8,0.8,1.0); 
translate(-5.0,  -3.8,  0.0);. 
letter(numl,  WHITE); 
popmatrix(); 


color  (RED); 
pushmatrix() ; 
translate(0.35,  0.8,  0.0); 
scale(0.8,0.8,1.0); 
translate(-5.0,  -3.8,  0.0); 
letter(num2,  WHITE); 
popmatrix(); 

}  /*  billboard  */ 


^********************************************** 


filename:  FIND  SUBGOAL.C 
author:  Tan  Chiam  Huat 
modified  by:  Michael  J.  Dolezal 
date:  May  20,  1987 


/ 


# include  "const. h" 

#include  "vars.ext.h" 

find  subgoal(no  coord,  where,  tolerance,  pred_distance,  vx,  vy,  px,  pz,  vz) 
float  pred  distance; 
float  tolerance; 


float  vx,  vy,  vz,  px,  pz; 
int  no  coord,  where; 

{ 

float  dist,  temp; 
float  x,  y,  z; 
int  i; 

if  (where  >  (no  coord  -  3))  where  =  0; 
for  (i  =  where;  i  <  no_coord;  ++i) 

{ 

x  =  roadmap  [i][0j  -  vx; 

y  =  roadmap(i][lJ  -  vy; 

z  =  roadmap[i](2]  -  vz; 

dist  =  sqrt(x*x  +  y*y); 

temp  —  pred  distance  -  dist; 

/*  converts  negative  to  positive  */ 
if  (temp  <  0)  temp  =  -(temp); 

if  (temp  <=  tolerance) 

{ 

if  (Istart) 

•  ( 

if  (vy  >  pz  kk  roadmap[i][l]  >  vy) 

{ 

start  =  TRUE; 
return  (i); 

} 

else  if  (vy  <  pz  kk  roadmap[i][l]  <  vy) 

{ 

start  =  TRUE; 
retum(i); 

} 

} 

else 

{ 

start  =  TRUE; 
retum(i); 

} 

> 

} 


/*  If  no  points  found,  return  an  error  code  */ 


retum(-l); 

}  /*  findjsubgoal  */ 

J ************************************  ********** 


filename:  INTEGRATE. C 
author:  Tan  Chiam  Huat 
modified  by:  Michael  J.  Dolezal 
date:  May  20,  1087 

********************************************** j 

/*  Runge-Kutta  2nd  order  numerical  integration  routine  */ 

^include  "const.h" 

#  include  "vars.ext.h" 

compute_new_state(condition) 

int  condition; 

{ 

float  xcap[5],  xdot[5]; 
int  i; 

derivative(state_vector,  xdot,  condition); 
for  (i  —  1;  i  <=  SYSTEMORDER;  ++i) 

/*  Euler  prediction  */ 

xcap[i]  =  state_vector[ij  +  xdotfi]  *  deltat; 

car  time  =  car  time  4-  deltat; 

derivative(xcap,  xdot,  condition); 

for  (i  =  1;  i  <=  SYSTEM  ORDER;  ++i) 

/*  Trapezodial  correction  */ 

state_vector[i]  =  (state  vector[i]  +  xdot[i] 

*  deltat  +  xcap{i))/2.0; 


}  /*  compute  new_state  */ 


derivative(work_vector,  xdot,  condition) 
float  work_vector[],  xdotfl; 
int  condition; 

{ 

xdot[l]  =  cos(work_vector[4])  *  work_vector[3|; 
xdot[2]  =  sin(work_vector[4j)  *  work  vector [3]; 


xdot[3]  =  -  (l/velocity_time_consant)  *  work_vector[3] 

+  (l/velocity_time_consant)  *  speed; 
if  (condition  ==  AUTOPILOT  |j  condition  ==  ASteerDrSp  || 
condition  ==  ASteerNSp) 

{ 

xdot  [4]  =  (heading_angle_rate_gain  *  sigma_dot)  + 

(heading_angle_gain  *  (sigma  -  work_vector[4j)); 
8teer_wheel  angle  =  xdot[4]/(tuming_response_gain  *  work_vector[3]); 
> 

else 


{ 

xdot[4]  =  turning  response  gain  *  work_vector[3] 
*  steer  wheel  angle; 


} 

}  /*  derivative  */ 

<*********** *********************************** 


filename:  DISPLAY.C 
author:  Tan  Chiam  Huat 
modified  by:  Michael  J.  Dolezal 
date:  May  20,  1987 


****************************************  ****** 


/ 


#include  "const. h" 

#  include  "vars.ext.h" 


y***********#******t****************************************** 


SPEEDOMETER 

************************************************************* 


makethespeedometer(speedometer) 
Object  ‘speedometer; 


{ 

coord  charxpos,  posl,  pos2,  tempx,  tempy; 
Object  meter, metemum; 

posl  —  467;  pos2  =  150; 
tempx  =  posl  +  90; 
tempy  =  pos2  +  80; 
charxpos  =  posl  +  30; 

/*  Generate  outline  for  speedometer  dial  */ 

meter— genobj(); 

makeobj  (meter) ; 
color(BLACK); 

rectfi(posl,  pos2,  tempx,  tempy); 
color(  WHITE); 

rectfi(posl+10,  pos2+10,  tempx-10,  tempy- 10); 
color(BLACK); 


cmov2i(pos  1  ,pos2- 1 5) ; 
charstrj"  km/hr  "); 

latri[0]  [0)==posl; 
latri(0][lj=190-9; 

latr  i  ( 1  ]  [0]  =pos  1  +25 ; 
latri[l)[l]=190; 

latri(2]  [0]=posl; 
latri[2]  [  1] —190+9; 

polf2(3,latri); 

ratri[0][0]=tempx; 
ratrijo]  [  l] = 190-9; 

ratri[l][0j= tempx; 
ratri[l](l]  =  190+9; 


ratri[2]  (0]=stempx-25; 

ratri[2][l]=190; 

polf2(3,ratri); 

clo8eobj(); 

/*  Generate  number  in  speedometer  display  */ 

meternum=genobj  ( ) ; 

makeobj(metemum) ; 

color(BLACK); 

cmov2i  (charxpos,000) ; 

charstr("000"); 

cmov2i(charxpos,030) ; 

charstr("OlO"); 

cmov2i(charxpos,060) ; 

charstr("020"); 

cmov2i(charxpos,090) ; 

charstr(M030"); 

cmov2i(charxpos,100) ; 

charstr(M040"); 

cmov2i(charxpos,125); 

charstr("050"); 

cmov2i(charxpos,150); 

charstr("060”); 

cmov2i(charxpos,175); 

charstr("070”); 

cmov2i(charxpos,200) ; 

charstr("080"); 

cmov2i(charxpos,225) ; 

charstr("090”); 

cmov2i(charxpos.250): 

charstr("100"); 

cmov2i(charxpos,275) ; 

charstr(''110"); 

cmov2i(charxpos,300); 

charstr("120”); 

cmov2i(charxpos,325) ; 

charstr("130"); 

cmov2i(charxpos,350); 


charstr("140w); 

cmov2i(charxpos,375); 

charstrC’lSO"); 

cmov2i(charxpos,400)  ; 

charstr("160"); 

cmov2i(charxp<>8,425) ; 

charstr("170w); 

cmov2i(charxpos,450); 

charstr(”180w); 

cmov2i(charxpos,475) ; 

charstr("190"); 

closeobj(); 

/*  Put  all  pieces  of  speedometer  together  */ 

*speedometer=genobj() ; 
makeobj  ( *  speedometer) ; 

/*  Draw  the  boundary  */ 

callobj  (meter); 

/*  Draw  the  display  speedometer  in  the  window  */ 

scrmask(charxpos,tempx,pos2+10,temRy-10); 

pushmatrixQ; 
transl4=gentag(); 
maketag  ( transl4 ) ; 
translate(0.0,0.0,0.0) ; 
c  al  lobj  ( meternum ) ; 
popmatrix(); 

/*  Reset  screenmask  to  full  size  screen  */ 
scnnask  (0.1023. 0.767); 

viewport  (0, 1023 ,0 ,767 ) ; 

closeobjQ; 

}  /*  makethespeedometer  */ 


W.VI 


^************************************************************* 

FUEL  METER 

*************************************************************/ 


makefuel(fuel) 

Object  ‘fuel; 

{ 

Coord  fuebcl,  fuelx2,  fuelyl,  fuely2; 

Object  fuelbound,fuellevel; 

fuebcl  =  277.0;  fuebc2  =  fuebcl  -f  51.0; 
fuelyl  *  10.0;  fuely2  =  340.0; 

/*  Generate  outline  for  fuel  indicator  */ 

fuelbound=genobj()  ; 
makeobj(fuelbound) ; 

color  (BLACK); 

rectf(fuelxl,  fuelyl,  fuelx2,  fuely2); 

cmov2(fuelxl  +  5.0,345.0); 
char8tr("fuelM); 

/*  Generate  hash  marks  for  fuel  levels  */ 

linewidth(3); 

move(fuelx2,  fuely2-30.0,  0.0); 
rdr(5.0,  0.0,  0.0); 

move(fuebc2,  fuely  1+60.0,  0.0); 
rdr(5.0,  0.0,  0.0); 


linewidth(l); 

closeobj(); 


/*  Generate  the  fuel  level  bar  that  moves 


fuellevel=genobj(); 
makeobj  (fuellevel) ; 
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7 


cIyIyIyI' 


color(  WHITE); 

rectf(fuelxl+4.0,  fuely  1+4.0,  fuelx2-4.0,  fuely2-4.0); 
cloeeobjQ; 


munnuiL 


/*  Put  all  pieces  of  fuel  together  */ 


*fuel=genobj(); 
makeobj(*fuel); 
callobj(fuelbound) ; 


callobj(fuellevel) ; 
color  (YELLOW); 


fuell  =  gentag(); 
maketag(fuell); 

rectf(fuelxl+4.0,  fuelyl+4.0,  fuelx2-4.0,  fuely2-4.0); 
color(BLACK); 


closeobj(); 

}  /*  makefuel  */ 


/ 


************************************************************* 


HELP  PANEL 


**************************************  ********  *************** 


makehelp(help) 
Object  *help; 

{ 

*help=genobj(); 

makeobj(‘help): 


color(BLACK); 


SI 


a 


a 


recti(10,10,265,340); 

/*  Generate  info  on  display  */ 

cmov2i(30,  315); 
charstr("Q:  AutoPilot"); 

cmov2i(30,  295); 
charstr("C:  Driver  Steer”); 

cmov2i(30,  275); 

charstr("R:  Cruise,  Nav  Steer"); 

cmov2i(30,  255); 

charstr("S:  AutoSt,  Dr  Speed"); 

cmov2i(30,  235); 

charstr("A:  AutoSt,  Nav  Speed"); 

cmov2i(30,  215); 
charstr("D:  Driver  Control"); 

cmov2i(30,  195); 

charstr("W:  Navigator  Control"); 
cmov2i(30,  175); 

charstr("X:  Dr  Steers,  Nav’s  Sp"); 
cmov2i(30,  155); 

charstr("F:  Nav  Steers,  Dr's  Sp"); 

cmov2i(30,  135); 
charstr("E:  Exit"); 

linewidth(2); 

cmov2i(28,95); 

charstr  ( "  Speed  " ) ; 

circi(29,80,6); 

circi(50,80,6); 

color(RED); 

circfi(71,80,6); 


color(BLACK); 
cmov2i(28,55); 
charstr  ("  Decel”); 
color(BLACK); 
circi(29,40,6); 
color  (RED); 
circfi(50,40,6); 
color  (BLACK); 
circi(71,40,6); 

cmov2i(140,  95); 
charstr  ( "  S  teering  "); 

move2i(l40,  80); 
draw2i(185,  80); 

move2i(150,  85); 
draw2i(140,  80); 

move2i(150,  75); 
draw2i(140,  80); 

move2i(175,  75); 
draw2i(185,  80); 

move2i(175,  85); 
draw2i(185,  80); 

cmov2i(140,  55); 
charstr  ( "  Brakes  " ) ; 

move2i(215,  65); 
draw2i(215,  25); 

move2i(210,  55); 
draw2i(215,  65); 

move2i(220,  55); 
draw2i(215,  65); 

move2i(210,  35); 
draw2i(215,  25); 


move2i(220,  35); 
draw2i(215,  25); 

linewidth(l); 

closeobjQ; 

}  /*  makehelp  *  / 

Jt^ift*************************************** ****************** 

ODOMETER 

*************************************************************  I 

maketheodometer  (odometer) 

Object  *  odometer; 

{ 

coord  posl,  pos2,  tempx,  tempy; 

Coord  temp,  charx,  chary; 

posl  =  467;  pos2  =  50; 

tempx  =  posl  +  90;  tempy  =  pos2  +  50; 

*  odometer  =  genobj(); 
makeobj  ( *  odometer ) ; 
color(BLACK); 

rectfi(posl,  pos2,  tempx,  tempy); 
color  (WHITE); 

rectfi(posl+5,  pos2+5,  tempx-5,  tempy-5); 
color  (BLACK); 

temp  =  (tempx  -  posl  -  10)/4; 
move2(posl-(-5+temp,  pos2+5); 
draw2(posl+5+temp,  tempy-5); 

move2(posl+5+temp  ‘ 2,  pos2+5); 
draw2(posl+5+temp*2,  tempy-5); 

move2(posl-f5+temp*3,  pos2+5); 
draw2(posl+5+temp*3,  tempy-5); 

move2(posl+5+temp*4,  pos2+5); 
draw2(posl+5-f-temp*4,  tempy-5); 
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charx  =  posl +5-1- temp/ 2;  chary  =  (tempy-pos2)/2+pos2-5.0; 


Icmov2(charx,  chary); 

odotagl  =  gentagQ; 

maketag(odotagl); 

charstr(”0M); 

cmov2(charx  +  temp,  chary); 
odotag2  =  gentag(); 
maketag  (odotag2 ) ; 

•J  charstr("0"); 


cmov2(charx  +  temp*2,  chary); 
odotag3  =  gentag(); 
maketag(odotag3) ; 
charstr("0"); 

cmov2(charx  +  temp*3,  chary); 
odotag4  =  gentagQ; 
maketag  (odotag4 ) ; 
charstr("0"); 

color  (BLACK); 
cmov2i(posl,pos2-15); 
charstr("  meter"); 
closeobj(); 

}  /*  maketheodometer  *  j 


^* ************ 


************************************ ************ 


WARNING 


PANEL 


*************************************************************^ 

makewarning  (warning) 

Object  ’warning; 

{ 

Coord  tempx,  tempy,  posl,  pos2; 

Coord  ix,  iy,  tempyl,  tempy2,  tempy3,  tempy4,  hg; 


posl  =  840.0;  pos2  =  10.0; 
tempx  =  posl  +  140.0;  tempy 


=  340.0; 


‘  ‘  •*'  •  '-*  >1' I v! 


* warning  =  genobj(); 
makeobj  ( *  warning) ; 


color(BLACK); 

rectf(posl,  pos2,  tempx,  tempy); 
hg  =  (330  -  5*iy)/4; 

dangertag  =  gentag(); 
maketag(dangertag) ; 
color  (RED); 

rectf(posl4-ix,  pos2-fiy,  tempx-ix,  pos24-iy4-hg); 
color(BLACK); 

cmov2(posl  4-  (tempx-posl)/2  -  25.0,  pos24-iy4-hg/2-5.0); 
charstr  ( "  D  anger" ) ; 

temptag  =  gentag(); 
maketag(temptag) ; 
color(RED); 

rectf(posl-(- ix,pos2+iy*2+hg, tempx-ix, pos2+iy*2+2*hg); 
color  (BLACK); 

cmov2(posl  4-  (tempx-posl)/2  -  12.0,  pos2+iy*2-l-hg-l-hg/2-5.0); 
charstr("Temp"); 

belttag  =  gentagQ; 
maketag(belttag) ; 
color  (RED); 

rectf  (pos  1 +ix  ,pos  2 +iy  *  3 + hg  *  2  ,tempx- ix  ,pos2 -(- iy  *  3 -f  3  *  hg ) ; 
color  (BLACK); 

cmov2(posl  -f  (tempx-posl)/2  -  40.0,  pos2+iy*3-l-hg*2-l-hg/2-5.0); 
charstr  ("Seat  Belt"); 

braketag  =  gentag(); 
maketag  ( braketag) ; 
color  (RED); 

rectf(posH-ix.pos2+iy*44-hg1'3.tempx-ix,pos2-i-iy*4+4J'hg); 

color(BLACK); 

cmov2(posl  4-  (tempx-posl)/2  -  17.0,  pos24-iy*44-hg*34-hg/2-5.0); 
charstr  ( "  Brake" ) ; 

color(BLACK); 

cmov2(posl420.0,  tempy-I^.O); 
charstr("  Warning"); 


closeobjQ; 

}  /*  makewarning  */ 

i* *****************************************************  ****** 

STEERING  WHEEL 

************************************************************* 

makesteerwheel(steerwheel) 

Object  *steerwheel; 

{ 

*steerwheel  =  genobj(); 
makeobj  ( *steerwheel) ; 

pushmatrix() ; 
color  (BLACK); 
circfi(512,  290,  40); 
color(  WHITE); 
circfi(512,  290,  30); 
color(BLACK); 

translate(512.0,  290.0,  0.0); 
steerwheeltag  =  gentagQ; 
maketag  (steerwheeltag) ; 
rotate(0,  ’Z’); 
rectfi(-33,  -5,  33,  5); 

popmatrixQ; 
closeobj(); 

}  /*  makesteerwheel  */ 


^******  *******************¥:*:***********  *********  ■*:*♦:******■♦.:*::«* 

HEADING  METER 


IIUUPUUUHI 


{ 


Object  meter,  theading; 

Coord  posl,  pos2,  tempx,  tempy; 
posl  =  heading_xpos;  pos2  =  350.0; 
tempx  =  posl  +  175.0; 
tempy  =  pos2  +  12.5; 


meter  =  genobjQ; 
makeobj  (meter) ; 
color  (BLACK); 

rectf(posl-2.5,  pos2-2.5,  tempx -1-2.5,  tempy +3. 5); 
color(  WHITE); 

rectf(posl,  pos2,  tempx,  tempy  +  1.0); 
closeobj(); 


/*  Generate  the  heading  on  top  of  the  terrain  map  */ 


theading=genobj  ( ) ; 
makeobj(theading) ; 
color  (BLACK); 


cmov2(000.0,pos2-2.0) ; 
charstr("340”); 


cmov2(045.0,pos2-2.0) ; 
charstr("350"); 


cmov2(090.0,pos2-2.0); 

charstr("360"); 


cmov2(135.0,pos2-2.0); 

charstr("010"); 


cmov2(  180.0, pos2-2.0); 
charstr("020"); 


cmov2(225.0,pos2-2.0); 

charstr(”030"); 


cmov2(270.0,pos2-2.0); 

charstr("040"); 


cmov2(315.0,pos2-2.0); 
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charstr("050”); 

cmov2(360.0,pos2-2.0); 

charstr("060"); 

cmov2(405.0,pos2-2.0); 

charstr("070"); 

cmov2(450.0,pos2-2.0); 

charstr("080"); 

cmov2(495.0,pos2-2.0) ; 
charstr("090"); 

cmov2(540.0,pos2-2.0) ; 
charstr(M100"); 

cmov2(585.0,pos2-2.0) ; 
charstr("110"); 

cmov2(630.0,pos2-2.0) ; 
charstr(,,120"); 

cmov2(675.0,pos2-2.0) ; 
charstr(”130"); 

cmov2(720.0,pos2-2.0); 

charstr(”140"); 

cmov2(765.0,pos2-2.0); 

charstr("150"); 

cmov2(810.0,pos2-2.0); 

charstr("160"); 

cmov2(85o.0,pos2-2.0) ; 
charstr("170"); 

cmov2(900.0,pos2-2.0); 

charstr("180"); 

craov2(945.0,pos2-2.0); 

cha^str(,,190,’); 


cmov2(990.0,pos2-2.0); 

charstr("200M); 


cmov2(1035.0,pos2-2.0); 

charstr("210M); 

cmov2(1080.0,pos2-2.0); 

charstr("220w); 

cmov2(1125.0,pos  2-2.0); 
charstr("230''); 

cmov2(1170.0,pos2-2.0); 

charstrC^O"); 

cmov2(1215.0,pos2-2.0); 

charstr("250"); 

cmov2(  1260.0,pos2-2.0) ; 
charstr("260"); 

cmov2(  1305.0, pos2-2.0)  ; 
charstr("270"); 

cmov2(1350.0,pos2-2.0); 

charstr("280"); 

cmov2(  1395.0, pos2-2.0) ; 
charstr("290"); 

cmov2(  1440.0, pos2-2.0) ; 
charstr("300"); 

cmov2(  1485.0, pos2-2.0); 
charstr("310”); 

cmov2  ( 1530.0, pos2-2 .0) ; 
charstr("320"); 

cmov2(1575.0,pos2-2.0); 

charstr("330"); 


cmov2(  1620.0, pos2-2.0) ; 


charstr("340"); 

cmov2(1665.0,pos  2-2.0); 
charstr(',350M); 

cmov2(  1710.0, pos2-2.0); 
charstr("360"); 

cmov2(1755.0,pos2-2.0); 

charstrC’OlO”); 

cmov2(1800.0,pos2-2.0); 

charstr("020"); 

color  ( BLACK); 

closeobj(); 

/*  Put  all  the  pieces  together  *  j 
‘heading  meter=genobj(); 
makeobj(  *heading_meter) ; 

/*  Draw  the  boundary  */ 

callobj  (meter); 

/*  Draw  the  heading  */ 

scrmask((int)  posl,(int)  tempx,(int)  pos2,(int)  tempy); 

pushmatrix(); 
transll=gentag(); 
maketag  ( transl  1 ) ; 

translate(0. 0,0.0, 0.0); 

callobj  (theading); 
scrmask  1 0.1023, 0.767): 
popmatrix(); 

color(RED); 

linewidth(4); 

move2(pos  1  +  1 75.0/2, pos2); 
draw2(posl  + 175. 0/2.  tempy); 


iinewidth(l); 


sc  rmask  (0,1023,0,767); 
closeobjQ; 

}  /*  makeheading  */ 

y**#*************************»****************************** 


BRAKE/CMDSPEEDGUAGES 


makegauges(gauges) 
Object  *  gauges; 

{ 


^gauges  =  genobj  ( ) ; 
makeobj  ( *  gauges ) ; 


/*  make  the  brake  gauge  */ 

cmov2i(BRAKEX  +  4,  BRAKEY  +  210); 
charstr  ("brakes” ) ; 

color(RED); 

manbraketag  =  gentag(); 
maketag(manbraketag); 

rectfi(BRAKEX,  BRAKEY.  BRAKEX  +  50,  BRAKEY): 
color(BLACK); 

scalegauge(BRAKEX,  BRAKEY); 

/*  make  the  cmdspeed  gauge  */ 

cmov2i(CMDX  -  6.  CMDY  +  226); 
charstr  ( "command" ) : 

cmov2i(CMDX  +  2,  CMDY  +  210); 
charstr(  "speed") ; 

color(GREEN); 
manspeedtag  =  gentag(): 
maketag(manspeedtag) ; 


rectfi(CMDX,  CMDY,  CMDX  +  50,  CMDY): 
scalegauge(CMDX.  CMDY); 

eloseobjQ; 

} 


S  C  A  L  E  G  U  A  G  E  (); 


scalegauge(basex,  basey) 
int  basex,  basey; 

{ 

char  tempstrjlO]; 
int  i; 


/*  outline  the  gauge  */ 


linewidth(2); 
color  (BLACK); 

recti(basex,  basey,  basex  +  50,  basey  4-  200); 
linewidth(l); 


/*  calibrate  the  gauge  */ 

for  (i  =  10;  i  <  100;  i  =  i  4-  10) 

{ 

move2i(basex,  basey  +  2  *  i); 
draw2i(basex  4-  13,  basey  4-  2  *  i); 

move2i(basex  4-  37,  basey  4-  2  *  i); 

draw2i(basex  4-  50,  basey  4-  2  *  i); 

cmov2i(basex  4-  16,  basey  4-  (2  *  i)  -  4); 

sprintf(tempstr.  "‘^d",  i): 
charstr(tempstr); 

} 

}  (*  scalegauge()  */ 

^t*****************************************?*** 


filename:  CHECKKEY.C 
author:  Michael  J.  Dolezal 
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date:  May  20,  1987 


***«******************************************/ 

#include  "gl.h" 

#include  "const. h" 

^include  "device. h" 

#include  "vars.ext.h" 

checkkeybd(ptnotdone,  ptdebug,  ptstart,  ptmode,  ptcondition) 

Boolean  *ptnotdone,  ♦ptdebug,  *ptstart; 
int  *  ptmode,  *  ptcondition; 

{ 

keypressed  =  NULL; 

*ptmode  —  *ptcondition; 

if  (qtest()) 

{ 

qread  (&keypressed ) ; 


switch(keypressed) 

{ 

case  ’q’: 

case  ’Q’:  if  (state  vector[3j  >  3.0) 

{ 

♦ptmode  =  AUTOPILOT: 
♦ptstart  =  FALSE; 

} 

break; 


/♦  Cruise  cont  and  driver  steer  */ 

case  V: 

case  C':  if  ((’ptmode  ==  ASteerNSp  |j  ‘ptmode  ==  ASteerDrSp)  &<&: 
(state  vector  3|  3. Oil 

{ 


♦ptmode  =  AUTOPILOT; 

♦ptstart  =  FALSE; 

} 

else  ‘ptmode  =  CruiseDrSteer; 
break; 

/♦  Cruise  cont  and  remote  steer  */ 
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case  ’R’:  if  (‘ptmode  ==  ASteerNSp  |j  ‘ptmode  ==  ASteerDrSp) 

{ 

♦ptmode  =  AUTOPILOT; 

‘ptstart  =  FALSE; 

} 

else  ‘ptmode  =  CruiseNavSteer; 
break; 

/*  Auto  speed  and  driver  speed  */ 

case  ’s’: 

case  ’S’:  if  (state_vector[3]  >  3.0) 

{ 

if  (‘ptmode  ==  CruiseNavSteer  ||  ‘ptmode  ==  CruiseDrSteer) 

{ 

‘ptmode  =  AUTOPILOT; 

‘ptstart  =  FALSE; 

} 

else  *ptmode  =  ASteerDrSp; 

} 

break; 

/*  Auto  speed  and  remote  steer  */ 

case  ’a’: 

case  ’A’:  if  (state_vector[3]  >  3.0) 

{ 

if  (*ptmode  =  =  CruiseNavSteer  j)  *ptmode  ==  CruiseDrSteer) 

{ 

♦ptmode  =  AUTOPILOT; 

*ptstart  =  FALSE; 

> 

else  *  ptmode  =  ASteerNSp; 

} 

break; 

/*  All  remote  manual  control  */ 

case  ’w’: 

case  "W‘:  ‘ptmode  =  NavManual: 

'ptstart  =  FALSE: 
break; 

case  ’d’: 

case  ’D’:  ‘ptmode  --  DrManual; 

‘ptstart  =  FALSE; 
break; 


case  V: 

case  ’X’:  *ptmode  =  DrSteerNavSp; 

*ptstart  =  FALSE; 
break; 

case  T: 

case  ’F’:  *ptmode  =  NavSteerDrSp; 

*ptstart  =  FALSE; 
break; 

case  V: 

case  ’E’:  *ptnotdone  =  FALSE; 
break; 

} 

} 

*ptcondition  =  *ptmode; 

}  /*  checkkeybd  */ 

y********************************************** 

filename:  WELCOME.C 
author:  Tan  Chiam  Huat 
modified  by:  Michael  J.  Dolezal 
date:  May  20,  1987 

**********************************************  j 

This  same  module  is  used  on  the  Navigator's  Display 
and  can  be  found  in  Appendix  A  of  this  study. 

^********************************************** 

filename:  LETTER. C 
author:  Tan  Chiam  Huat 
modified  by:  Michael  J.  Dolezal 
date:  May  20,  1987 

******************************** **************/ 

/ *  This  file  contains  routines  to  display  block  alphabetic  characters 
suitable  for  inclusion  into  graphics  objects.  These  letters  are 
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used  instead  of  IRIS  FONTS  when  one  desires  to  treat  them  as 
graphics  objects  that  can  be  rotated,  scaled,  etc.  (font  char¬ 
acters  can’t)  * 

/*  This  file  includes  routines  for  27  characters,  "A"  through  "Z", 
and  also  and  "  "  (blank)  (but  not  "G","Q","V","W","X",Z") 

/*  The  routine  draws  the  desired  letter  in  absolute  coordinates. 

in  the  center  of  the  display.  * / 

/*  To  use  these  routines,  the  color  desired  for  the  letter  must 
be  specified  when  the  object  is  created  (in  the  user  program), 
and  the  desired  backgound  color  must  be  passed  to  the  routine.  */ 

/*  Original  version  written  by  J.  Artero  and  R.  Kirsch;  current 

version  written  by  L.  Williamson,  digits  added  by  Mike  Dolezal.  */ 

# include  "gl.h" 

#include  "device.h" 

letter(asci,backcoIor) 

int  asci;  /*  index  of  character  we  want  to  display  *  / 

Color  index  backcolor;  /*  specified  background  color  */ 

{ 

Coord  box  (8j[2j;  /*  vector  of  coordinates  forming  the 

vertices  of  a  letter  object  */ 

switch(asci) 

{ 

case  A  : 

box[0][0) =4.6875; 
box(0][lj=3.25; 
box[l][0]  =4.9375; 
box[lj(l]=4.25; 
box[2][0] =5.0625; 


box[2][l]=4.25; 
box(3](0] =5.3125; 
box[3][l]=3.25; 
polf2(4,box); 

color  (backcolor); 

box[0][0] =4.8125; 

box[0]  [l] =3.25; 

box[l][0]  =4.84375; 

box[l][l]=3.375; 

box[2][0]=5.15625; 

box[2][l]=3.375; 

box[3][0]=5.1875; 

box[3][l]=3.25; 

polf2(4,box); 

box[0][0j=4.875; 

box[0][l]=3.5; 

box[l][0j=5.0; 

box[l][l]=4.0; 

box(2]  [0] =5.125; 

box[2][l]=3.5; 

polf2(3,box); 

break; 

case  ’B’: 

box[0][0] =4.6875; 

box[0][l]=3.25: 

box[l)[0j=4.6875; 

box[l][l]=4.25; 

box[2][0]=5.1875; 

box[2][lj=4.25; 

box[3][0] =5.3125; 

box[3][l]=4.125; 

box[4][0| =5.3125; 

box[4][l]=3.375; 

box[5]  [0]=5. 1875; 

box[5]  [  lj =3.25; 

polf2(6,box); 

color  (backcolor)  ; 
box[0]  [0] =5.25; 
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box[0][l]=3.8125; 

box(l][0]=5.3125; 

box(lj[l]=3.875; 

box(2][0]=5.3125; 

box[2][l]  =  3.75; 

polf2(3,box); 

box[0][0]=4.8125; 

box[0][l]=3.375; 

box[l][0]=4.8125; 

box[lj[lj=3.75; 

box[2][0]=5.125; 

box[2][l]=3.75; 

box[3][0]=5.1875; 

box  [3]  [  1  ] = 3 .6875 ; 

box[4][0]=5.1875; 

box[4][l]=3.4375; 

box[5][0]=5.125; 

box[5][l]=3.375; 

polf2(6,box); 

box  [0]  [0] =4.8125; 
box[0][l]=3.875; 
box[lj[0]=4.8125; 
box[l][l]=4.125; 
box[2]  [0] =5.125; 
box[2][l]=4.125; 
box[3][0]=5.1875; 
box[3][l]=4.0625; 
box[4][0]=5.1875; 
box[4][l]=3.9375; 
box[5][0]=5.125; 
box[5][lj=3.875; 
polf2(6,box); 
break; 
case  ’C’: 

box[0][0]=4.6875; 
box[0]  [lj  =  3.375; 
box[l]  [0]  =  4.6875; 
boxjl]  [l]  =4.125; 
box[2]  [0]  =4.8125; 
box[2][lj=4.25; 


*.  \  .v 


box[3j[0]=5.1875; 

box[3][l]=4.25; 

box  [4]  [0] = 5 . 3 125 ; 

box[4][l]=4.125; 

box[5][0]=5.3125; 

box[5][l]=3.375; 

box[6][0]=5.1875; 

boxf6]fl]=3.25; 

box[7][0]=4.8125; 

box[7][l]=3.25; 

polf2(8,box); 

color  (backcolor); 

box[0j[0]=4.8125; 

box[0][lj=3.4375; 

box[l][0|=4.8l25; 

box[l][l]=4.0625; 

box[2][0]=4.875; 

box[2j[l]=4.125; 

box[3][0]=5.125; 

box[3][l]=4.125; 

box[4][0]=5.1875; 

box  [4]  [lj— 4 .0625 ; 

box  [5]  [0] = 5 . 1 87 5 ; 

box[5][l]=3.4375; 

box[6][0]=5.125; 

box[6][l]=3.375; 

box[7][0]=4.875; 

box[7][l]=3.375; 

polf2(8,box); 

rectf(5.1875, 3.5, 5.3125, 4.00); 
break; 

case  D’: 

box  [0]  [0] = 4 .6875 ; 

box[0][l]=3.25; 

box[lj[0]=4.6875; 

box[lj[l]=4.25; 

box[2][0]=5.1875; 

box[2][l]=4.25; 


box[3][0]=5.3125; 

box[3j[l]=4.125; 

box[4]  [0] =5.3125; 

box[4][l]=3.375; 

box[5j[0]=5.1875; 

box[5][l]=3.25; 

polf2(6,box); 

color  (backcolor) ; 

box[0][0]=4.8125; 

box[0][l]=3.375; 

box[l][0]=4.8125; 

box[lj[l]=4.125; 

box[2][0]=5.125; 

box[2][l]=4.125; 

box[3]  [0] =5. 1875; 

box[3][l]=4.0625; 

box[4][0]=5.l875; 

box[4][l]=3.4375; 

box[5](0]=5.125; 

box[5][l]=3.375; 

polf2(6,box); 

break; 

case  ’E’: 

rectf(4.6875, 4.125, 5.25, 4.25); 
rectf(4.6875, 3.25, 5.3125.3:375); 
rectf(4.6875, 3.25, 4.8125, 4.25); 
rectf(4.8125, 3.75, 5.0625, 3.875); 

break; 

case  ’F’: 

rectf(4.6875,3.25,4.8125,4.25); 
rectf(4.6875, 4. 125, 5.3125, 4.25); 
rectf(4.8125, 3. 75, 5.125, 3.875); 


break; 


rectf(4.6875, 3.25, 4.8125, 4.25); 
rectf(4.8125, 3.6875, 5.1875, 3.8125); 
rectf(5.1875, 3.25, 5.3125, 4.25); 

break; 


case  T: 


rectf(4.6875, 4. 125, 5.3125, 4.25); 
rectf(4.6875, 3.25, 5.3125, 3.375); 
rectf(4.9375,3.25 ,5.0625, 4.25) ; 

break; 


case  ’J’: 


box[0j[0] =4.6875; 

box[0][lj  =3.375; 

box[l][0] =4.6875; 

box[l][lj=3.625; 

box[2][0]=5.3l25; 

box[2]Jl]=3.625; 

box[3][0]=5.3125; 

box[3][l]=3.375; 

box[4][0]=5.1875; 

box[4][l]=3.25; 

box[5][0]=4.8125; 

box[5][lj=3.25; 

polf2(6,box); 

rectf(5.2, 3.625, 5.3125, 4 .25) ; 

color(backcolor); 

box[0j[0]=4.8125; 

box[0][l] =3.4375; 

box[l][0]=4.8125; 

box[lj[l]=3.625: 

box(2j[0j=5.1875; 

box[2][l]=3.625; 

box[3j[0j  =  5.1875; 

box[3][lj  =  3.4375; 

box(4][0j  =  5.125; 

box[4][lj=3.375; 

box[5|[0]=4.875; 


box[5][l] =3.375; 
polf2(6,box); 

break; 


case  ’K’: 

rectf(4.6875, 3.25, 5.3125, 4.25); 

color  (backcolor) ; 
box[0]  [0] =4.8 125; 
box[0][l] =3.875; 
box[l][0]  =4.8125; 
box[l][lj=4.25; 
box[2]  [0]=5.125; 
box[2][lj=4.25; 
polf2(3,box); 

box[0]  [0]=5.02; 

box[0][l] =3.875; 

box[lj[0]=5.3125; 

box[ljjl]=4.25; 

box[2][0]  =5.3125; 

box[2][lj=3.25; 

polf2(3,box); 

box[0]  [0]  =4.8125; 
box[0][lj=3.25; 
box[l][0]  =4.8125; 
box[l](lj=3.625; 
box[2][0]=4.9; 
box[2]  [l] =3.74; 
box[3]  [0] =5.14; 
box[3][l]=3.25; 
polf2(4,box); 

break; 

case  ’L’: 

rectf(4.6875, 3.25, 4.8125, 4.25); 
rectf(4.6875, 3.25, 5.3125, 3.375); 
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break; 


case  ’M’: 

rectf(4.6875, 3.25, 5.3125, 4.25); 

color  (backcolor); 

box  [0]  [0] = 4 .68 75 ; 

box(0][l]=4.25; 

box[lj[0]=5.3125; 

box[l]  [l]  =4.25; 

box[2)(0j=5.0; 

box[2](l]=3.75; 

polf2(3,box); 

box  [0]  [0]  =4 . 8 125 ; 

box[0][l]=3.25; 

boxjl](0]=4.8125; 

box[lj[l]=3.8125; 

box[2][0]=5.125; 

box[2]  [l]  =3.25; 

polf2(3,box); 

box[0][0] =4.875; 

box[0][l]=3.25; 

box[l][0]=5.1875; 

box[l)[l]=3.8125; 

box[2][0]=5.1875; 

box[2][l]=3.25; 

polf2(3,box); 

break; 

case  ’N’: 

rectf(4'.6875, 3.25, 5.3125, 4.25); 

color  (backcolor); 

box  [0]  [0] =4.8125; 

box[0]jl]=3.25; 

box[lj[0]=4.8125; 

box[l](lj=3.9375; 

box(2][0]=5.1875; 

box[2]  [l]  =  3.25; 


polf2(3,box); 
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box[0][0]  =4.8125; 

box[0](lj=4.25; 

box[l][0]=5.1875; 

box[lj[l]=4.25; 

box[2][0|=5.1875; 

box[2][lj=3.5625; 

polf2(3,box); 

break; 

case  ’O’: 

box[0]  [0]=4.6875; 

box[0][lj=3.375; 

box[l][0] =4.6875; 

box[l][l]=4.125; 

box[2j[0]=4.8125; 

box[2][l]=4.25; 

box{3][0]=5.1875; 

box[3][lj=4.25; 

box[4][0]=5.3125; 

box|4][lj=4.125; 

box[5][0]=5.3125; 

box[5][l]=3.375; 

box[6]  [0]=5.1875; 

box[6][l]=3.25; 

box[7]  [0]=4.8 125; 

box[7][l]=3.25; 

polf2(8,box); 

color  (backcolor); 

box[0][0]=4.8125; 

box[0][lj=3.4375; 

boxjl]  [0] =4 .8 125; 

box[lj[lj=4.0625; 

box[2][0]=4.875; 

box[2|[l]=4.125; 

box[3]  [0]=5.125; 

box[3][l]=4.125; 

box[4][0]=5.1875; 

box[4][l]=4.0625; 

box[5][0]=5.1875; 
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box(5][l] =3.4375; 

box[6|[0]=5.125; 

box[6][l]=3.375; 

box[7](0]=4.875; 

box[7][l]=3.375; 

polf2(8,box); 

break; 

case  ’P’: 

box[0]  [0]  =4 .6875; 

box[0]jl]=3.25; 

box(l][0]=4.6875; 

box[lj[l]=4.25; 

box[2][0]=5.1875; 

box[2][l]=4.25; 

box[3][0]=5.3125; 

box[3][lj=4.125; 

box[4][0]=5.3l25; 

box[4](lj=3.25; 

polf2(5,box); 

color  (backcolor); 

box[0](0]=4.8125; 

box[0][lj=3.25; 

box[lj[0]=5.3125; 

box[lj[l}=3.8125; 

box[2][0] =5.3125; 

box[2][lj=3.25; 

polf2(3,box); 

box[0][0] =4.8125; 

box[0][l]=3.8125; 

box[l][0]=4.8125; 

box[l][lj=4.125; 

box[2][0]=5.125: 

box[2j[l]=4.125; 

box[3][0]=5.1875; 

box[3][l]=4.0625; 

box[4][0]=5.1875; 

box[4][lJ=3.875; 

box[5][0j=5.125; 

box(5][lj=3.8125; 


polf2(6,box); 

rectf(4.8125.3.25,5. 3125.3.6875); 

break; 

case  ’R’: 

box[0][0]=4.6875; 

box[0](l]=3.25; 

box[lj[0]=4.6875; 

box[lj[l]=4.25; 

box[2][0]=5.1875; 

box[2][lj=4.25; 

box[3][0]=5.3125; 

box[3][lj=4.125; 

box[4]  [0] =5.3 125; 

box[4][lj=3.25; 

polf2(5,box); 

color(backcolor); 

box[0][0]=5.1875; 

box[0][l]=3.625; 

box[l][0]=5.3l25; 

box[l][l]=3.75; 

box[2][0]=5.3125; 

box[2][lj=3.25; 

po!f2(3,box); 

box[0][0]=4.8125: 

box[0][lj=3.75; 

box[lj[0]=4.8125; 

box[l)[lj=4.125; 

box[2][0]=5.125; 

box[2][l]=4.125; 

box[3j[0]=5.1875; 

box[3j[l]=4.0625: 

box[4][0j=5.1875; 

box[4][l]  =  3.8125; 

box(5][0]=5.125; 

box[5][lj=3.75; 

polf2(6,box); 


box[0][0]=4.8125; 


box[0][l]=3.25; 

box(lj[0]=4.8125: 

box(l][lj=3.625: 

box[2][0]=5.05; 

box[2][lj =3.625: 

box[3j(0]=5.l75: 

box[3)[lj=3.25; 

polf2(4,box); 

break: 

case  ’S?: 

box[0][0] =4.6875; 

box[0][lj=3.375; 

box[lj[0]=4.6875; 

box  [l][l]=4.125; 

box(2l[0]  =4.8125: 

box[2]  [l] =4.25; 

box[3][0]=5.1875; 

box[3][l]=4.25; 

box[4][0]=5.3125; 

box[4][l]=4.125; 

box[5ljo]=5.3125: 

box[5j[l]=3.375: 

box(6]j0]=5.1875; 

box[6][l]=3.25; 

box[7][0]=4.8125; 

box[7][l]=3.25; 

polf2(8,box); 

color  (backcolor); 
box[0]  [0] =4. 81 25; 
box[0][lj=3.4375; 
box[l][0]=4.8125: 
box[l  j  [lj  =  3.75; 
box[2j  [0]  =5.125: 
box[2][l]=3.75; 
box[3)(0]=5.l875; 
box[3][l]=3.6875; 
box[4][0]  =  5.l875; 
box[4j[l|=3.4375; 
box(5][0]=5.l25; 
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rectf(4.6875, 4. 125, 5.3125, 4.25); 
rectf(4.9375,3.25, 5.0625, 4.25): 
break; 


case  T’: 

box(0][0]  =4.6875; 

box[0][l] =3.375; 

box  [  1  j  [0] = 4 .68 75 ; 

box[lj[lj=4.25; 

box[2j[0j=5.3125; 

box[2][lj=4.25; 

box[3][0j=5.3125; 

box[3j[l]=3.25; 

box[4][0]  =4.8125; 

box[4][l]=3.25; 

polf2(5,box); 

color(backcolor) ; 

box[0][0]=4.8125; 

box[0j[l]=3.4375; 

box[l)[0] =4.8125; 

box[l][l]=4.25; 

box[2j[oj=5.1875; 

box[2][l)=4.25; 

box[3](0]=5.1875; 

box[3][l] =3.5325; 

box[4j[0]=5.01; 

box[4][l] =3.375; 

box[5j  [0] =4.875; 

box[5j[l]=3.375; 

polf2(6,box); 

box[0](0] =5.0625; 

box[0][lj=3.25; 

box[l][0]=5.1875; 

box[lj[lj  =  3.375; 

box[2][0j=5.1875; 

box[2]  [  l]  =  3.25; 

polf2(3,box); 


break; 


case  ’Y’: 

box[0][0]  =4.6875; 

box[0][l]=4.25; 

box[l][Oj =4.9375; 

box[l][l]=3.75; 

box  [2]  [0] = 5 .0625 ; 

box[2][l]=3.75; 

box[3]  [0] =4 .8 125; 

box(3j[l]=4.25; 

polf2(4.box); 

box[0][0]  =4.9375; 

box[0]jlj=3.75; 

box[l][0] =5.0625; 

box[lj[l]=3.75; 

box[2][0]=5.3125; 

box[2][lj=4.25; 

box[3][0]=5.1875; 

box[3][l]=4.25; 

polf2(4,box); 

rectf(4.9375,3.25, 5.0625, 3.75); 
break; 
case  ’1’: 

rectf(4.9375,  3.25,  5.0625,  4.25); 
break; 
case  ’2’: 

box[0]  [0] =4. 6875; 

box  [0]  [  l]  =  3 .25; 

box[l][0]=4.6875: 

box[l][l]=4.25; 

box(2][0]=5.1875: 

box(2][lj=4.25; 

box[3][0]=5.3125; 

box[3][l]=4.125; 

box[4][0]=5.3125; 

boxj4][l]=3.375; 
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box[5][0]=5.1875; 

box[5][lj=3.25; 

polf2(6,box); 

color  (backcolor); 
box[0][0]=5.25; 
box[0][l]=3.8125; 
box[lj[0]=5.3125; 
box[lj  [l] =3.875; 
box[2][0] =5.3125; 
box[2][l]=3.75; 
polf2(3,box); 

box[0][0]=4.8125; 

box[0][l]=3.375; 

box[l]  [0]  =4.8 125; 

box[lj[l]=3.75; 

box[2][0]=5.125; 

box[2][l]=3.75; 

box[3][0]  =5.1875; 

box[3][l] =3.6875; 

box[4][0]=5.1875; 

box[4][l]=3.4375; 

box[5]  [0] =5.125; 

box[5][l]=3.375; 

polf2(6,box); 

box[0][0]=4.8125; 

box[0][l]=3.875; 

box[l][0]=4.8125; 

box[lj[l]=4.125; 

box[2][0]=5.125; 

box[2][l]=4.125; 

box[3][0j=5.1875; 

box[3][l]  =4.0625; 

box[4][0]=5.1875; 

box[4j[l]=3.9375; 

box[5][0]=5.125; 

box[5j[lj=3.875; 

polf2(6,box); 

color  (backcolor); 
box(0][0]=4.8125; 


box[0][l]=3.875; 
box[l][0]=4.8125; 
box[l][lj=4.125; 
box[2]  [0] =4.6875; 
box[2j[l]=4.125; 
box[3]  [0] =4.6875; 
box[3][lj=3.875; 
polf2(4,box); 

color(backcolor) ; 

box[0][0] =5.3125; 

box[0][l]=3.875; 

box[l][0j=5.125; 

box[l][l]=3.75; 

box[2][0]=5.125; 

box[2][l]=3.45; 

box[3][0]=5.3125; 

box[3][l]=3.45; 

polf2(4,box); 

break; 

case  ’3’: 


box[0][0]  =4.6875; 

box[0][l]=3.25; 

box[lj[0j=4.6875; 

box[lj[l]=4.25; 

box[2j[0]=5.1875; 

box[2][l]=4.25; 

box[3][0]=5.3125; 

box[3]  [l] =4 . 125; 

box[4][0]=5.3125; 

box[4][l]=3.375; 

box[5j  [0] =5.1875: 

box[5][lj=3.25: 

polf2(6,box); 

color(backcolor); 
box[0][0]=5.25; 
box[0][l]  =  3.8125; 
box[lj[0j=5.3125; 
box[l][l]=3.875; 
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box[2]  [0]  =5.3125; 

box[2][l]=3.75; 

poif2(3,box); 

box[0][0]=4.8125; 

box[0][l]  =3.375; 

boxjljjoj  =4.8125; 

box[l][l]=3.75; 

box[2][0]=5.125; 

box[2][lj=3.75; 

box[3][0]=5.1875; 

box[3][l]=3.6875; 

box[4][0]=5.1875; 

box[4][lj=3.4375; 

box[5]  [0] =5. 125; 

box[5][l]=3.375; 

polf2(6,box); 

box[0]  [0] =4 .8 125; 

box[0][l] =3.875; 

box[l][0]=4.8125; 

box[l][l]=4.l25; 

box[2][0]=5.125; 

box[2][l]=4.125; 

box[3][0]=5.1875; 

box[3][lj=4.0625; 

box[4][0]=5.1875; 

box[4][l] =3^9375; 

box[5][0j=5.125; 

box[5][l]=3.875; 

polf2(6,box); 

color(backcolor) ; 
box[0][0]=4.6875; 
box[0][l]=3.375; 
box[lj[0]  =4.6875; 
box[lj[lj=4.125; 
box[2j  [0]  =4.8125; 
box[2]  [l]  =4.125; 
box[3]  [0]=4.8125; 
box[3][lj=3.375; 
polf2(4,box); 

break; 
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rectf(5.1875,  3.25,  5.3125,  4.25); 
rectf(4.6875,  3.75,  5.3125,  3.875); 
rectf(4.6875,  3.75,  4.8125,  4.25); 

break; 

case  ’5’: 

box[0]  [0] =4 .6875 ; 

box[0][l]=3.25; 

box[lj[0]=4.6875; 

box[lj[l]=4.25; 

box[2][0]=5.3125; 

box[2][l]=4.25; 

box[3][0] =5.3125; 

box[3][l]=3.375; 

box[4][0]=5.1875; 

box[4][l]=3.25; 

polf2(5,box); 

color  (backcolor); 

box[0][0]=5.25; 

box[0][l]=3.8125; 

box[l][0]=5.3125; 

box[l]  [l] =3.875; 

box[2]  [0] =5.3125; 

box[2][l]=3.75; 

polf2(3,box); 

box[0][0]  =4.8125; 

box[0][l]=3.375; 

box[l][0]=4.8125; 

box[lj[lj=3.75; 

box[2][0]=5.125; 

box[2][l]=3.75; 

box[3][0]=5.1875; 

box[3][l]=3.6875; 

box(4][0]=5.1875; 

box[4][l] =3.4375; 

box[5]  [0] =5.125; 

box[5][lj=3.375; 

polf2(6,box); 


box{0]  [0]  =4 .8125; 

box[0]|l]=3.875; 

box[l][0)=4.8125; 

box[l][l]=4.125; 

box[2][0]=5.125; 

box[2][l]=4.125; 

box[3]  [0] =5. 1875; 

box[3]jl] =4.0625; 

box  [4]  [0] = 5 . 1 8 7 5 ; 

box[4][l] =3.9375; 

box(5][0]=5.125; 

box[5][l]=3.875; 

polf2(6,box); 

color  (backcolor); 

box[0][0]=5.25; 

box[0][l]=3.8l25; 

box[l][0]=5.3125; 

box[lj[l]=3.875; 

box[2][0] =5.3125; 

box[2][l]=4.125; 

box[3][0]=5.125; 

box[3][l]=4.125; 

box[4]  [0]=5.125; 

box[4][l]=3.875; 

polf2(5,box); 

box[0]  [0]  =4.8125; 
box[0]jl]=3.375; 
box[l][0]=4.8125; 
box[l]  [l]  =3.75; 
box[2][0]=4.6875; 
box[2][l]=3.75; 
box[3]  [0] =4. 6875; 
box[3]  [  l]  =  3.375; 
polf2(4.box); 

break; 

case  ’6’: 

box[0](0]=4.6875; 
box[0][lj=3.25; 
box[l][0] =4.6875; 
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box[l][l]=4.25; 

box(2][0]=5.1875; 

box[2][l]=4.25; 

box[3][0] =5.3125; 

box[3][l]=4.125; 

box[4][0]=5.3125; 

box[4][l]=3.375; 

box[5][0]=5.1875; 

box[5][l]=3.25; 

polf2(6,box); 

color  (backcolor); 

box[0][0]=5.25; 

box[0][l] =3.8125; 

box[l][0]=5.3125; 

box[lj[l]=3.875; 

box[2j[0]=5.3125; 

box[2][l]=3.75; 

polf2(3,box); 

box[0]  [0] =4.8125; 

box[0j[l]=3.375; 

box[l][0]=4.8125; 

box[l][l]=3.75; 

box[2](0]=5.125; 

box[2][l]=3.75; 

box[3]  [0]=5.1875; 

box[3j[l]=3.6875; 

box[4]  [0] = 5 . 1 875 ; 

box[4][lj=3.4375; 

box[5][0]=5.125; 

box[5][l]=3.375; 

polf2(6,box); 

box[0][0]=4.8125; 
box[0j[l]  =  3.875; 
boxjl]  [Oj  =4.8125; 
box[lj[l]=4.125; 
box[2]  [0]  =  5.1 25; 
box[2]  [l]  =4.125; 
box[3j  [0]  =  5.1875; 
box[3j[l]=4.0625; 
box[4][0]=5.1875; 


box[4]  [  l] = 3 .9375 ; 
box(5][0]=5.125; 
box(5j(lj=3.875; 
polf2(6,box); 

box[0j(0] =5.3125; 
box[0][l]=3.75; 
boxjljjoj =5.3125; 
box!  l][l]  =4. 125; 
boxj2][oj=5.125; 
box[2][lj=4.125; 
box[3][0]=5.125; 
box[3][l]=3.875; 
polf2(4,  box); 

break; 


rectf(4.9375.3.35, 5.0625, 3.60); 
rectf(4.9375, 3.90, 5.0625, 4. 15); 

break; 

case  ’ 

break; 

}  /*  end  switch  */ 

}  /*  end  routine  "letter" 

/**************************************** 

filename:  NETV.C 
author:  James  Manley 
modified  by:  Michael  Zvda 
date:  April  29,  1987 

*******¥************+******************** 

This  is  the  same  routine  used  in  the  Navigator" 
Display.  The  code  for  the  module  can  be  found 
Appendix  A  of  this  study. 
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y**************************«***********«******* 

filename:  LOAD  ARRAY. C 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 

^**************************************«******  j 

r 

Reads  road  map  into  system  array  named  roadmap 

7 

finclude  "const. h" 

# include  "vars.ext.h" 

^include  "stdio.h" 

^include  -<ermo.h> 
int  loadarray() 

{ 

int  i; 

FILE  *fp; 

if  ((fp  =  fopen ( " roadmap " , "r " ) )  ==  NULL) 

{ 

printf(" Cannot  read  roadmap. \n"); 
retum(-l); 

} 

else  for  (i  =  0:  !feof(fp):  ++i) 

fscanf(fp,"%f  %i  %F',  &roadmap[i][0],  &roadmap[i][l], 
&roadmap[i][2j); 

setbell(’l’); 

ringbell(); 

setbell('2’); 

ringbell(): 

retum(--i); 

} 

/******  ********** ****************************** 


filename:  CONST. H 


author:  Michael  J.  Dolezai 
date:  May  20,  1987 


********************************************** 


I 


K 


6 


All  program  constants  are  defined  in  this  file 


typedef  float  Dimension; 


^include  "gl.h" 

# include  "device.h" 

#include  "math.h" 

#include  "time.h" 
finclude  "stdio.h" 

# define  SYSTEM  ORDER  4 

#define 

MOUNTAIN 

8 

#  define 

MOUNTAINl 

9 

#  define 

SKY 

10 

#  define 

FIELD 

11 

#define 

WARN 

12 

#  define 

WALL 

13 

#  define 

SIDEWALL 

14 

#  define 

ROOF 

15 

#define 

WINDOW 

16 

#  define 

CHMWALLl 

17 

# define 

CHMWALL2 

18 

#  define 

SIDEROOF 

19 

#  define 

FRAME 

20 

# define 

SIDEWALLl 

21 

^define 

WALLl 

22 

#  define 

ROOFl 

23 

#  define 

FRAMEl 

24 

#  define 

WINDOWl 

25 

#  define 

DIMGREEN 

26 

#  define 

DIMYELLOW 

27 

# define 

DIMRED 

28 

#  define 

GRAY 

29 
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#  define 

#  define 

#  define 

#  define 
f  define 

#  define 
§  define 
§  define 

#  define 
#define 

#  define 

#  define 
# define 

#  define 

#  define 

#  define 

#  define 

#  define 
# define 
4 define 

#  define 
# define 
4  define 
4  define 

#  define 

#  define 
4  define 
4  define 


MAXFUEL  3000.0 

PI  3.14 

Crossroadlen  4000 
REDLIGHT  1 

YELLOWLIGHT  2 
GREENLIGHT  3 

ON  1 

OFF  0 

MPSTOKMPH  3.6 
RAD  TO  DEG  57.2215 
BENDRADIUS  76.0 
ROADWIDTH  16.0 
ROADLEN  400.0 

LAPDIST  2174 

DrManual  0 

ASteerNSp  1 

CruiseNavSteer  2 
AUTOPILOT  3 

CruiseDrSteer  4 
ASteerDrSp  5 

NavManual  6 

DrSteerNavSp  7 
NavSteerDrSp  8 
BRAKEX  397 

BRAKEY  10 

CMDX  577 

CMDY  10 

BRAKEGAIN  0.0015 


/*  This  is  equivalent  to  (360)/(2  *  PI)  */ 


/**.x  **************:«  *******  **********  *********** 


filename:  VARS.H 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 


:  *  *  x  *  *  *  *  4;  *  *  *  x  *  *  «  •':«***■<  .k  *;  a:  **************  ^  :*:•***  *  ^ 


All  global  variables  are  in  this  file. 


Tag  transl4,  transl3,  transl2; 

Tag  transit,  transl,  trans22; 

Tag  odotagl,  odotag2,  odotag3,  odotag4; 

Tag  dangertag,  temptag,  belttag,  braketag; 

Tag  fuell,  roadlooktag,  skylooktag,  stopsigntag; 

Tag  greenlighttag,  yellowlighttag,  redlighttag; 

Tag  steerwheeltag,  terrainllooktag; 

Tag  manbraketag,  manspeedtag; 

Tag  houselooktag,  housetranstag; 

Tag  housescaletag; 

Tag  house llooktag,  houseltranstag; 

Tag  houselscaletag; 

Coord  latri(3][2],  ratri[3] [2] ; 
float  fuelbar,speedbar; 

float  fuelquant  =  MAXFUEL;  /*  Maximum  fuel  available  */ 
float  headingxpos  =  429.5;  /*  Heading  indicator  position  */ 

float  speedinc  =  1.0;  /*  Speed  increment /decrement  */ 

Device  keypressed; 

Boolean  start  =  FALSE;  /*  Start  of  program  flag  */ 

r 

Larger  turning  response  gain  corresponds  to  "stiff” 
steering  and  lower  value  corresponds  to  "sloppy" 
steering.  Large  velocity  gain  corresponds  to  sedan 
automobile  and  smaller  value  corresponds  to  sport  car. 

Operator  has  control  over  steer  wheel  angle  and  speed 
using  the  mouse. 

Car  time  is  the  integration  timer. 

7 

float  state  vector{5]; 
float  velocity  time  consant  =  9.0; 
float  turning  response  gain  =  0.02; 
float  heading  angle  gain  =  0.294; 
float  headingangle  rate  gain  =  0.828; 

float  steer  wheel  angle  =  0.0;  /*  Unit  is  radian  */ 
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float  prediction  time 

=  1.17;  /*  Unit  is  second  */ 

float  sigma  dot 

=  0.0; 

float  steer  inc 

=  0.10;  j*  Unit  is  radian  */ 

float  car  time 

=  0.0; 

float  deltat 

=  0.17; 

float  speed 

=  0.0; 

float  sigma 

=  0.0; 

/*  IRIS  allow  such  a 

large  array  only  if  it  is  global  */ 

float  roadmap  [5000]  [3]; 

Angle  Fov 

=  1000;  /*  Field  of  view  100  deg  */ 

int  distance  =  0; 

/*  distance  traveled  */ 

filename:  VARS. EXT. H 
author:  Michael  J.  Dolezal 
date:  May  20,  1987 


All  external  variables  are  in  this  file 


extern 

extern 

extern 

extern 

extern 

extern 

extern 

extern 

extern 

extern 

extern 

extern 


Tag  transl4,  transiS,  transl2; 

Tag  transit,  transl,  trans22; 

Tag  odotagl,  odotag2,  odotag3,  odotag4; 

Tag  dangertag,  temptag,  belttag,  braketag; 

Tag  fuell.  roadlooktag.  skylooktag,  stopsigntag; 
Tag  greenlighttag,  yellowlighttag,  redlighttag; 
Tag  steerwheeltag,  terrainllooktag; 

Tag  manbraketag,  manspeedtag; 

Tag  houselooktag,  housetranstag; 

Tag  housescaletag; 

Tag  housellooktag,  houseltranstag; 

Tag  houselscaletag; 


extern  Coord  latri[3][2],  ratri[3j  [2] ; 


extern  float  fuel  bar, speed  bar; 
extern  float  fuelquant; 
extern  float  heading  xpos; 
extern  float  speedinc; 

extern  Device  keypressed; 

extern  Boolean  start; 

extern  float  state_vector[5|; 

extern  float  velocity_time_consant; 

extern  float  turning_response_gain; 

extern  float  headinganglegain; 

extern  float  headinganglerategain; 

extern  float  steer_wheel  angle; 

extern  float  prediction  time; 

extern  float  sigma  dot; 

extern  float  steerinc; 

extern  float  car  time; 

extern  float  deltat; 

extern  float  speed; 

extern  float  sigma; 

extern  float  roadmap  [5000]  [3]; 

extern  Angle  Fov; 

extern  int  distance; 

I******* *************************************** 

filename:  MAP.C 
author:  Tan  Chiam  Huat 
modified  by:  Michael  J.  Dolezal 
date:  May  20,  1987 

********************************************** j 

r 

This  module  works  independently  from  the  rest  of  the  system. 


It  generates  the  road  map  for  autonomous  navgiation. 

Original  by  Tan  Chiam  Huat,  modified  by  Mike  Dolezal  to  complete  the 
circuit  with  the  car  in  the  right  lane. 

7 

#include  <stdio.h> 

#include  <math.h> 

mainQ 

{ 

FILE  *fp; 
int  i: 

/*  Road  Specification  */ 

/*  Note:  Must  match  that  used  in  the  carsimu.c  program 

float  bendradius  =  76.0; 
float  roadwidth  =  16.0; 
float  lenl  =  400.0; 
float  len2  =  400.0; 
float  len3  =  400.0; 
float  len4  =  400.0; 
float  newx,  newy,  miss; 
float  calx,  caly,  start  rad; 
float  perstep  rad; 

/*  road  map  increment  step  */ 

float  step  =  1.0; 

float  radl  =  bendradius; 

float  rad2  =  bendradius; 

float  rad3  =  bendradius; 

float  rad4  =  bendradius; 

float  lastxvalue: 

float  lastyvalue; 

float  xl.  yl.  zl: 

float  x2.  y2.  z2: 

float  x3,  y3,  z3; 

float  x4,  y4,  z4; 

float  x5,  y5,  z5; 

float  x6,  y6,  z6; 

float  x7.  y7,  z7; 

float  x8,  y8.  z8: 


/*  Road  Segment  Specifications  */ 


A  ,«4  .U  .U*  .*!* 


#i*  I,*  It* 


xl  =  0.0;  yl  =  0.0;  zl  =  0.0; 

x2  =  0.0;  y2  =  lenl;  z2  =  0.0; 

x3  =  radl;  y3  =  y2  +  radl;  z3  =  0.0; 

x4  =  x3  +  len2;  y4  =  y3;  z4  =  0.0; 

x5  =  x4  +  rad2;  y5  =  y4  -  rad2;  z5  =  0.0; 

x6  =  x5;  y6  =  y5  -  len3;  z6  -  0.0; 

x7  =  xo  -  rad3;  y7  =  y6  -  rad3;  z7  =  0.0; 

x8  =  x7  -  len4;  y8  =  y7;  z8  =  0.0; 

fp  =  fopen(',roadmap","w,,); 

newy  =  yl; 

for  (i  =  0;  newy  <=  y2;  4-+i) 

{ 

#ifdef  DEBUG 

printf("%.2f  %.2i  %.2f\n",xl,newy,zl); 

#endif 

fprintf(fp,"%.2f  %.2f  %.2f\n",xl,newy,zl); 
lastyvalue  =  newy; 
newy  +  =  step; 

} 

newy  =  lastyvalue; 
miss  =  y2  -  newy; 

#ifdef  DEBUG 

printf("missl  %.2f\n",miss); 

4endif 

start  rad  =  0; 
if  (miss  >  0) 

{ 

startrad  =  miss/radl; 
calx  =  cos(start  rad); 
caly  =  sin(start  rad); 
newy  4-  =  caly: 
newx  -+=  calx; 

#ifdef  DEBUG 

printf("%.2f  %.2f  %.2f\n",x2+newx,y2+newy,z2); 
#endif 

fprintf(fp,"%.2f  %.2f  %.2f\n",x2-|-newx,y2+newy,z2); 
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perstep_rad  =  step/radl; 
for  (i  =  0;  newx  <=  x3;  +  +i) 

{ 

startjrad  +=  perstep_rad; 
calx  =  radl  *  cos(start  rad); 
caly  =  radl  *  sin(start  rad); 
lastxvalue  =  newx; 
lastyvalue  =  newv; 
newy  =  y2  +  caly; 
newx  =  x2  4-  (radl  -  calx); 
if  (newx  <  x3) 

{ 

#ifdef  DEBUG 

printf("%.2f  %.2f  %. 2f\n", newx, newy ,z2); 

#endif 

fprintf(fp."%.2f  %.2f  /o.2f\n".newx-newv,z2); 

} 

} 

newx  =  lastxvalue; 
newy  =  lastyvalue; 
miss  =  x3  -  newx; 

#ifdef  DEBUG 

printf("miss2  <%.2f\n",miss); 

#endif 

if  (miss  >  0) 

{ 

newx  =  x3  +  miss; 

*ifdef  DEBUG 

printf(" /c,.2f  %.2f  %.2f  vn",newx,y4,z3); 

#endif 

fprintf(fp,"%.2f  %.2f  %.2f\n",newx,y4,z3); 

} 


for  (i  =  0;  newx  <=  x4;  4-4-i) 


lastxvalue  =  newx; 
newx  -f-=  step; 
if  (newx  <=  x4) 

{ 

#ifdef  DEBUG 

printf("%.2f  %.2f  %.2f\n",newx,y4,z3); 

#endif 

fprintf(fp,"%.2f  %.2f  %.2f\n",newx,y4,z3); 

} 

} 

newx  —  lastxvalue; 
miss  =  x4  -  newx; 

#ifdef  DEBUG 

printf("miss3  %.2f\n",miss); 

#endif 

start  rad  =  0: 
if  (miss  >  0) 

{ 

startrad  =  miss/r?d2; 
caly  =  rad2  *  cos(startrad); 
calx  =  rad2  *  sin  (start  rad); 
newy  =  y4  -  (rad2  -  caly); 
newx  =  x4  +  calx; 

#ifdef  DEBUG 

printf("%.2f  %.2f  %.2f\n", newx, newy, z4); 
#endif 

fprintf(fp,"%.2f  %.2f  %.2f\n", newx, newy ,z4); 

} 

perstep  rad  =  step/ rad  1: 
for  (i  =  0;  newy  >=  y5;  ++i) 

{ 

start  rad  +=  perstep  rad; 
caly  =  rad2  *  cos  (start  rad); 
calx  =  rad2  *  sin(start  rad); 
lastxvalue  =  newx; 
lasty  value  =  newy; 


newx  =  x4  +  calx; 
newy  =  y4  -  (rad2  -  caly); 
if  (newy  >=  y5) 

{ 

#ifdef  DEBUG 

printf("%.2f  %.2f  Sc.2f\n", newx, newy ,z4); 

#endif 

fprintf(fp,"%.2f  %.2f  %.2f\n", newx, newy  ,z4); 

} 

} 

newx  =  lastxvalue; 
newy  =  lastyvalue; 
miss  =  newy  -  y5; 

#ifdef  DEBUG 

printf("miss4  %.2f\n",miss); 

#endif 

if  (miss  >  0) 

{  . 

newy  =  y5  +  miss; 
f  ifdef  DEBUG 

printf("%.2f  %.2f  %.2f\n", newx, newy ,z5); 

#endif 

fprintf(fp,"%.2f  %.2f  %.2f\n", newx, newy ,z5); 

} 

for  (i  =  0;  newy  >=  y6;  ++i) 

{ 

lastyvalue  =  newy; 
newy  -=  step; 
if  (newy  >=  y6) 

{ 

#ifdef  DEBUG 

printf("%.2f  %.2i  %. 2f\n", newx, newy ,zo); 

#endif 

fprintf(fp,"%.2f  %.2f  %. 2f\n'\ newx, newy, z5); 

} 

} 

newy  =  lastyvalue; 


miss  =  newy  -  y6; 

#ifdef  DEBUG 

printf("miss5  %.2f\n",miss); 

#  end  if 

start  _r  ad  =  0; 
if  (miss  >  0) 

{ 

start  rad  =  miss/rad3; 
calx  =  rad3  *  cos(start  rad); 
caly  =  rad3  *  sin  (start  _rad); 
newx  =  x6  -  (rad3  -  calx); 
newy  =  y6  -  caly; 

#ifdef  DEBUG 

printf("%.2f  %.2f  %.2f\nM, newx, newy  ,z5); 

#endif 

fprintf(fp."%.2f  %.2f  %.2f\n", newx, newy ,z5); 

} 

persteprad  =  step/rad3; 
for  (i  =  0:  newx  >=  x7;  ++i) 

{ 

start  rad  +=  perstep_rad; 
calx  =  rad3  *  cos  (start  rad); 
caly  =  rad3  *  sin(start_rad); 
lastxvalue  =  newx; 
lastyvalue  =  newy; 
newy  =  y6  -  caly; 
newx  =  x6  -  (rad3  -  calx); 
if  (newx  >=  x7) 

{ 

#ifdef  DEBUG 

printf("9c.2f  %.2f  %.2f\n", newx, newy ,z5); 

#endif 

fprintf(fp,"%.2f  %.2f  %.2f\n", newx, newy ,z5); 

} 

} 

newx  =  lastxvalue; 
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newy  =  lastyvalue; 
miss  =  newx  -  x7; 


#ifdef  DEBUG 

printf("miss6  %.2f\n",miss); 
fendif 

if  (miss  >  0) 

{ 

newx  =  x7  -  miss; 

#ifdef  DEBUG 

printf("%.2f  %.2f  %.2f\n",newx,y8,z8); 
#endif 

fprintf(fp,"%.2f  %.2f  %.2f\n",newx,y8,z8); 

} 

for  (i  =  0;  newx  >=  x8;  ++i) 

{ 

lastxvalue  =  newx; 
newx  -=  step; 
if  (newx  >=  x8) 

{ 

#ifdef  DEBUG 

printf("%.2f  %.2f  %.2f\n",newx,y8,z8); 
#endif 


fprintf(fp,"%.2f  %.2f  %.2f\n",newx,y8,z 

} 

} 

newx  =  lastxvalue; 
miss  =  newx  -  x8; 

#ifdef  DEBUG 

printf("miss7  %.2f\n",miss); 

#  end  if 

/*  Process  curve  #4  */ 

newx  =  lastxvalue; 
newy  =  lastyvalue; 


miss  =  x8  -  newx; 


#ifdef  DEBUG 

printf("miss8  %.2f\n'\miss); 

#endif 

startrad  =  0; 
if  (miss  >  0) 

{ 

start  rad  =  miss/rad4; 
caly  =  rad4  *  cos  (start  _rad); 
calx  =  rad4  *  sin(start_rad); 
newy  =  y8  +  (rad4  -  caly); 
newx  =  x8  -  calx; 
fifdef  DEBUG 

printf("%.2f  %.2i  %.2f\n", newx, newy ,z4); 

#endif 

fprintf(fp,"%.2f  %.2f  %.2f\n'\newx,newy,z4); 

} 

perstep  rad  =  step/radl; 
for  (i  =  0;  newy  <=  yl;  -f-fi) 

{ 

start  rad  -f—  perstep  rad; 

caly  =  rad4  *  cos(start  rad); 

calx  =  rad4  *  sin(start  rad); 

lastxvalue  =  newx; 

lastyvalue  =  newy; 

newx  =  x8  -  calx; 

newy  =  y8  +  (rad4  -  caly); 

if  ((newy  >=  y8)  &&  (newy  <  =  yi)) 

{ 

#ifdef  DEBUG 

printff'St  .2f  %.2f  % . 2f  \ n " ,newx,newy ,z8 ) ; 

#endif 

fprintf(fp,"%.2f  %.2f  %. 2f\n", newx, newy ,z 

} 

} 

fclose(fp); 

}  j*  main  */ 


filename:  MAKEFILE 
author:  Tan  Chiam  Huat 
modified  by:  Michael  J.  Dolezal 
date:  May  20,  1987 

**************************** 

CFLAGS  =  -Zf 
SRCS  =  other.c\ 
netV.c\ 
integrate^ 
display  .c\ 
letter. c\ 
welcome.c\ 
find  subgoal. c\ 
checkkey.c\ 
loadarray.c 
circuit. c\ 
carsimu.c 

OBJS  =  other.o\ 
netV.o\ 
integrate.o\ 
display  .o\ 
welcome.o\ 
carsimu.o\ 
find  subgoal.o\ 
checkkey.o N 
loadarray.o\ 
circuit. o\ 
letter.o 

carsimu:  $(OBJS) 

cc  -o  carsimu  $(OBJ$)  -Zf  -Zg  -im  -lbsd  -ldbm 


$(OBJS):  const. h 


INITIAL  DISTRIBUTION  LIST 


Defense  Technical  Information  Center 
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Alexandria,  Virginia  22304-6145 

Library,  Code  0142 
Naval  Postgraduate  School 
Monterey,  California  93943-5002 

Dr.  Robert  B.  McGhee,  Code  52Mz 
Department  of  Computer  Science 
Naval  Postgraduate  School 
Monterey,  California  93943-5000 

Dr.  Michael  J.  Zyda,  Code  52Zk 
Department  of  Computer  Science 
Naval  Postgraduate  School 
Monterey,  California  93943-5000 

Center  for  Naval  Analyses 
2000  N.  Beauregard  Street, 

Alexandria,  Virginia  22311 

Director  of  Research  Administration 
Code  012 

Naval  Postgraduate  School 
Monterey,  California  93943 

Mr.  Russel  Davis 
HQ,  USACDEC 
Attention:  ATE  (MM 
Fort  Ord,  California  93941 

LCDR  H.  R.  Everett 

Naval  Oceans  Systems  Center,  Code  442 

San  Diego,  California  92152 


9. 


Dr.  William  E.  Isler 

Defense  Advanced  Research  Projects  Agency/ISTO 
1400  Wilson  Blvd. 

Arlington,  Virginia  22209 

10.  Dr.  Andrew  Chang 

Central  Engineering  Laboratories 
FMC  Corporation 
1185  Coleman  Ave,  Box  580 
Santa  Clara,  California  95052 

11.  Dr.  James  Lowrie 
Mail  Stop  T0427 

Martin  Marietta  Denver  Aerospace 

P.O.  Box  179 

Denver,  Colorado  80201 

12.  Dr.  D.  Y.  Tseng 
Artificial  Intelligence  Center 
Hughes  Research  Laboratories 
23901  Calabasas  Rd. 

Calabasas,  California  91302-1579 

13.  Prof.  R.  E.  Fenton 

Dept,  of  Electrical  Engineering 
Ohio  State  University 
2015  Neil  Avenue 
Columbus,  Ohio  43210 

14.  Prof.  K.  W.  Olson 

Dept,  of  Electrical  Engineering 
Ohio  State  University 
2015  Neil  Avenue 
Columbus.  Ohio  43210 

15.  Major  Michael  J.  Doiezai 
1322  Rue  Crozat 

Baton  Rouge,  Louisiana  70810 

16.  Chief  of  Naval  Operations 

Director,  Information  Systems  (OP-945) 

Navy  Department 
Washington,  DC  20350-2000 


17.  Mr.  Doug  Gage 

Naval  Oceans  Systems  Center,  Code  442 
San  Diego,  California  92152 

18.  Chairman 

Computer  Science  Department,  Code  52 
Naval  Postgraduate  School 
Monterey,  California  93943-5000 

19.  Curricular  Officer 

Computer  Technology  Programs,  Code  37 
Naval  Postgraduate  School 
Monterey,  California  93943-5000 
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